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ABSTRACT 


This  project  investigates  the  use  of  single-chip  microprocessors  as  nodes  in  a  token 
ring  control  network  and  explores  the  implementation  of  a  protocol  to  manage 
communication  across  such  a  network. 

A  control  network  is  useful  when  the  event  to  be  controlled  is  located  at  some 
distance  from  the  inputs  required  to  control  it;  likewise,  a  control  network  is  useful  when 
an  apphcation  receives  inputs  from  more  sources  than  a  single  microprocessor  is  capable 
of  handling.  Such  a  network  allows  nodes  to  share  only  the  information  that  is  essential 
for  each  to  perform,  eliminating  the  need  for  a  powerful  and  costly  computer.  This  makes 
it  exiremely  effectwe  in  a  wide  variety  of  apphcations  ranging  from  missiles  to  home 
security  systems  to  "smart”  automobiles.  One  type  of  control  network  is  the  token  ring 
network,  where  each  node  is  connected  serially  with  the  node  immediately  following  it  and 
the  one  preceding  it.  Its  eflBciency,  simphcity,  and  determinacy  make  it  an  excellent  choice 
in  a  small  control  network. 

A  specific  scenario  is  examined  where  the  position  of  a  marble  along  a  motor- 
drnen  track  is  controlled  using  inputs  from  a  user  operating  a  PC  as  well  as  a 
microcomputer-drKen  interface  module,  an  optical  encoder  mounted  on  the  motor,  and  a 
camera  located  above  the  track.  Using  the  information  of  the  state  variables  as  well  as 
preferences  of  the  user,  a  digital  control  s>'stem  is  developed  to  move  the  marble  to  the 
proper  position. 
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1 .  Problem  Statement 


The  purpose  of  this  project  is  to  create  a  serial  network  of  microprocessors 
capable  of  performing  control  operations  using  sensors  from  remote  locations.  This 
network  will  be  involved  in  controlling  the  position  of  a  spherical  marble  along  a  tilting 
beam  driven  by  a  DC  motor.  Tlie  desired  position  of  the  ball  can  be  specified  by  the  user 
using  some  manner  of  input,  and  the  actual  position  will  be  determined  using  image  data 
from  an  analog  camera.  A  microprocessor  responsible  for  controlling  the  motor  will 
operate  using  a  control  law  also  specified  by  the  user.  This  vyill  require  that  one  node  in 
the  network  be  a  PC  on  which  the  user  may  test  his  control  law  before  appKing  it. 

There  is  a  need  for  a  protocol  designed  with  the  control  network  in  mind,  ready  to 
handle  frequent  bursts  of  data.  A  major  goal  in  this  project  is  to  explore  a  common 
protocol  whereby  any  number  of  single-chip  microprocessors  may  communicate  with  one 
another,  making  the  project  more  universal  in  scope.  This  protocol  should  make  it  easy  to 
add  or  remove  nodes  anywhere  in  the  network  as  different  sensor  output  stations  are 
needed.  The  number  of  microprocessors  in  the  network  will  vary  according  to  the 
requirement  of  the  specific  problem  at  hand.  This  number  will  grow  as  the  project  grow's 
m  scope  and  complexiU’.  The  exact  number  of  nodes  is  not  important,  but  it  must  be  a 
number  great  enough  to  test  the  network’s  capabilities  of  communication. 

An  important  issue  in  the  project  is  to  make  certain  that  each  microprocessor  is 
able  to  continue  with  its  assigned  task  even  as  it  receives  data  from  other  nodes  in  the 
network.  The  purpose  of  this  project  is  not  only  to  create  a  message  protocol  but  to 
allow  microprocessors  to  perform  useful  work  and  still  participate  in  thig  network.  In  all 
of  the  microprocessors,  it  takes  some  time  to  recewe  and  process  an  incoming  message 
and  prepare  and  transmit  an  outgoing  one.  The  critical  issue  is  what  a  microprocessor  is 
to  do  if  it  is  about  to  perform  an  important  function  and  receives  an  incoming  message. 

For  example,  the  microprocessor  responsible  for  monitoring  the  position  of  the  ball  will 
take  position  data  at  a  periodic  rate  and  may  be  forced  to  miss  a  pass  if  it  is  processing 
information  from  the  network.  Perhaps  it  is  acceptable  to  miss  a  pass  and  use  the  data 
obtamed  on  the  last  pass,  or  perhaps  it  is  not.  This  issue  must  be  dealt  with  for  each  of  the 
microprocessors  in  the  network. 

The  specific  problem  to  test  the  ability  of  this  network  protocol  is  the  position 
control  of  a  ball  which  moves  along  a  tilting  track.  Figure  1.1  shows  the  track  and  baU 
combination  with  the  two  position  states,  x  and  6 ,  labeled.  The  user  can  specify  a  desired 
position  either  through  the  use  of  a  personal  computer  or  through  the  turning  of  a  shaft 
with  a  shaft  encoder  attached.  By  using  position  and  velocity  data  of  the  ball  from  a 
camera  positioned  above  the  track  and  angular  position  and  velocity  data  from  a  shaft 
encoder  attached  to  the  motor,  a  control  law  using  state  feedback  will  be  designed  to 
achieve  proper  response  from  the  motor  in  order  to  balance  the  ball  at  the  desired 
position. 

Four  nodes  will  interact  m  this  network:  three  single-chip  Peripheral  Interface 
Controller  (PIC)  microprocessors  and  one  personal  computer  (PC).  The  PC  will  allow  the 
user  to  view  information  on  a  monitor  as  well  as  to  update  the  desired  position  of  the  ball 
or  change  the  control  law  that  the  problem  is  following.  One  PIC  will  be  dedicated  to 
controlling  the  motor  which  turns  the  track.  A  second  PIC  monitors  data  from  the 


camera,  while  a  third  serves  as  a  link  between  the  network  and  the  PC  o  ^ 

mpu,  so^ce  for  the  desired  position.  If  these  four  nodes  are  abfe  to  3 


Figure  l.I.  Diagram  of  Mechanical  System 
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2.  Background 


2.1  Networking 

A  co^:^)uter  network  is  a  s\'stem  consisting  of  two  or  more  indhidual  stations,  or 
nodes,  configured  in  such  a  way  as  to  allow  data  to  be  exchanged  between  the  nodes. 

This  information  sharing  is  governed  by  a  network  protocol,  a  set  of  rules  which  govern 
all  facets  of  the  communication  —  it  “defines  connectors,  cables,  signals,  data  formats, 
and  error-checking  techniques  as  well  as  algorithms  for  network  interfaces  and  nodes, 
allowing  for  standard  —  to  within  a  network  —  principles  of  message  preparation, 
transfer,  and  analysis  on  different  levels  of  detaU”  [1]. 

The  choice  of  a  protocol  for  a  particular  network  invoK'es  many  factors,  which  will 
be  discussed  later.  In  general  there  are  two  different  kinds  of  networks:  centralized 
networks  and  decentralized  (or  distributed)  networks.  Centralized  networks  contain  a 
master  node,  which  governs  all  traffic  on  the  network.  Typically  each  of  the  other  nodes, 
termed  sla\'es.  can  communicate  only  with  the  master  node  and  not  among  themseh  es. 

The  master  node  is  often  a  much  more  pow'erfiil  processor  than  the  slave  nodes  because  it 
is  responsible  for  performing  most  of  the  work.  In  a  distributed  netw'ork.  on  the  other 
hand,  each  of  the  nodes  has  the  same  right  to  use  the  network  as  any  other  node.  The 
processors  used  in  each  node  are  usuaUy  very  .similar  in  power,  as  each  node  is  responsible 
for  performing  a  relatwely  equal  amount  of  work. 

A  comparison  between  centralized  networks  and  distributed  networks  reveals 
adx  antages  and  disadvantages  of  each.  The  protocol  for  centralized  networks  is  usually 
much  simpler  than  the  one  for  distributed  networks  [1].  On  the  other  hand,  the  response 
times  of  distributed  networks  are  typically  faster  because  each  node  can  communicate 
directly  with  the  other  nodes  instead  of  passing  all  information  through  a  master  node. 
Distributed  s\'stems  also  allow  each  fiinaion  to  be  performed  by  a  processor  which  has  the 
necessaiy'  capabihties  for  that  specific  fimction  instead  of  a  single  complex  computer 
performing  all  operations,  thus  avoiding  unnecessar>'  complexity  for  simpler  operations 
[2]. 

A  network  can  also  be  categorized  according  to  the  geographical  distribution  of  its 
nodes.  A  wide  area  network,  or  WAN,  spans  great  distances  and  may  contain  nodes 
scattered  across  a  country  or  a  continent.  A  local  area  network,  or  LAN,  on  the  other 
hand,  is  a  network  in  which  there  is  a  much  shorter  distance  between  each  node,  often  on 
the  order  of  several  kilometers.  Before  the  1970’s  most  LANs  used  as  data  networks 
were  centralized  systems.  Since  then  many  different  distributed  network  protocols  have 
been  introduced,  such  as  Xerox’s  Ethernet,  Datapoint’s  Arcnet,  and  IBM’s  Token  Ring 
[!]• 

LANs  may  fiirther  be  divided  into  two  very  distinct  categories  according  to  the 
type  of  operation  the  network  is  to  perform.  These  categories  are  data  networks  and 
control  networks.  A  data  network  is  what  is  often  pictured  when  the  term  network  is 
mentioned-several  PC’s  sharing  files  in  an  office  via  a  central  server,  for  example.  This 
type  of  network  differs  drastically  from  the  network  that  is  useful  to  systems  engineers  — 
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the  control  network.  In  general  data  networks  send  large  packets  of  data  infrequently, 
and  require  a  high  data  transmission  rate  when  sending  these  data.  Control  networks,  on 
the  other  hand,  receive  huge  bursts  of  data  packets,  dubbed  ‘ordered  traflSc’  [3].  These 
bursts  occur  very  frequently  and  are  very  short  in  length,  usually  less  than  20  bytes.  A 
control  network  must  operate  with  nodes  which  are  performing  time-critical  functions  and 
cannot  pause  indiscriminately  for  data  reception  or  transmission. 

The  networks  mentioned  above-Arcnet,  Ethernet,  and  Token  Ring-were  all 
introduced  for  use  in  data  networks,  but  similar  frameworks  have  also  been  used  in  control 
networks.  There  are  several  factors  to  consider  in  determining  the  framework  to  use  in  a 
control  network.  These  factors  include  interoperability,  eflBciency,  determinacy, 
robusmess,  and  cost  per  node. 

Interoperability  refers  to  the  abihty  of  the  network  to  perform  when  not  all  nodes 
or  connections  are  alike.  “The  network  protocol  must  be  open.  Its  availability  to  anyone 
on  equal  terms  is  crucial  to  the  ability  of  products  from  different  manufacturers  to  work 
together  on  the  network”  [3].  This  requires  an  acceptance  of  a  standard  protocol  by  the 
manufacturers.  A  second  issue  of  interoperability  is  the  need  to  work  in  varied  operating 
environments  with  mixed  media  access.  ‘Tor  example,  portions  of  a  system  may  require 
expensive  fiber  in  noisy  environments,  while  other  portions  can  tolerate  low-cost  twisted 
pair  wires  in  benign  environments”  [4]. 

The  protocol  efficiency  of  a  control  network  refers  to  the  ratio  of  the  number  of 
message  bits  delivered  compared  to  the  total  bandwidth  of  the  network.  Since  only  some 
of  the  bits  in  the  message  are  data  bits  and  the  others  are  overhead  bits  used  for  message 
routing  and  other  network  tasks,  an  obvious  way  to  optimize  efficiency  is  to  reduce  the 
number  of  overhead  bits  required  to  send  a  constant  number  of  data  bits.  Efficiency  is  also 
a  function  of  packet  size  since  the  overhead  is  often  a  fixed  length.  For  example,  a  thirty- 
two  bit  message  may  contain  only  eight  bits  of  data  and  twenty-four  bits  containing  node 
address  and  protocol  mstructions.  Protocol  efficiency  is  generaUy  divided  into  two 
categories:  heavy  traffic  efficiency  and  light  traffic  efficiency.  As  will  be  seen,  some 
protocols  work  well  in  one  but  not  the  other. 

A  third  property  of  a  control  network  that  demands  attention  is  determinacy. 
“Determinacy,  or  the  ability  to  calculate  worst-case  response  time,  is  inqjortant  for 
meeting  the  real  time  constraints  of  many  embedded  control  applications”  [4].  Most 
systems  contain  some  sort  of  prioritization  scheme  where  nodes  that  control  tasks 
requiring  immediate  execution  may  take  temporary  control  of  the  network  to  send  their 
traffic.  Determinacy  is  extremely  important  so  that  a  network  architect  will  know  whether 
a  likelihood  exists  for  the  entire  network  to  freeze  as  a  result  of  multiple  nodes  attempting 
to  gain  access  to  it. 

Many  network  applications  require  robust  operation  m  order  for  success.  A 
network  is  robust  if  it  can  respond  easily  to  unforeseen  and  unwanted  changes  in  the 
network  such  as  an  added  node,  deleted  node,  or  lost  token,  for  example.  It  is  also 
desirable  for  a  network  to  be  able  to  respond  quickly  in  the  event  that  a  power  surge  or 
glitch  causes  a  reset. 

Finally,  the  cost  per  node  is  one  of  the  paramount  considerations  in  network 
design.  Different  topologies  and  protocols  require  differing  amounts  of  hardware  and 
software  resources  depending  on  the  simplicity  or  complexity  of  the  protocol.  For  cost- 
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sensitive  high  volume  applications  a  simpler  protocol  is  often  desirable;  a  more  complex 
protocol  is  useful  when  application  growth  is  expected  [4], 

It  was  mentioned  above  that  no  definite  standards  for  control  networks  have  yet 
been  introduced.  However,  there  has  been  experimentation  in  several  broad  areas 
including  polling,  time  division  multiple  access  (TDMA),  token  ring,  token  bus,  binary 
countdown,  carrier  sense  multiple  access  with  collision  detection  (CSMA/CD)  and  carrier 
sense  multiple  access  with  collision  avoidance  (CSMA/CA).  These  seven  protocols  each 
have  advantages  and  disadvantages  according  to  the  application  of  the  network  [4], 

Polling  is  a  popular  method  for  control  networks  because  of  its  simphcity'  and 
determinacy.  One  processor  (node)  typically  polls  each  of  the  other  processors  in  turn  to 
determine  if  they  have  traffic  to  send  and  then  gives  them  permission  to  do  so.  This  is 
ideal  for  applications  with  centralized  data  acquisition  where  prioritization  and  node-to 
node  communication  is  not  required.  Polling,  however,  requires  a  large  amount  of 
network  bandwidth  due  to  hs  two  way  communications  and  is  therefore  unacceptable  for 
high  speed  applications  [4]. 

The  TDMA  protocol  is  used  extensK'ely  in  aerospace  operations.  Similar  to 
poUbg.  a  TDMA  network  functions  by  a  master  node  sending  a  synchronization  signal  to 
each  of  the  other  nodes  so  they  are  in  essence  running  on  the  same  clock.  Each  node  is 
then  assigned  a  time  shce  when  it  may  transmit.  TDMA  uses  much  less  bandwidth  than 
polling,  but  node  costs  are  increased  because  each  node  requires  a  stable  clock  for 
synchronization.  An  additional  disadvantage  is  the  need  for  fixed-time  transmissions  so 
the  nodes  do  not  exceed  their  allotted  time  [4]. 

A  token  ring  network  consists  of  nodes  connected  to  one  another  in  a  ring  shape. 
There  is  no  common  bus  in  the  token  ring  protocol;  each  node  is  connected  only  to  tw  o 
other  nodes.  A  token  message  is  sent  fi'om  node  to  node  around  the  ring  until  a  node  has 
something  to  send.  This  node  then  replaces  the  token  with  its  message  which  is 
transferred  fi'om  node  to  node  until  it  reaches  its  destination.  The  determinacy  of  tbic 
protocol  is  very  good  since  worst-case  token  passing  time  can  easily  be  calculated. 
Throughput  efficiency  during  both  heax'y  and  Ught  traffic  situations  is  very  good  since  idle 
token  passing  decreases  as  traffic  increases.  Looking  to  the  future,  the  token  ring 
network’s  point-to-point  coimections  adapt  easily  to  the  growing  field  of  fiberoptics.  One 
unportant  disadvantage  is  that  a  failure  of  any  one  node  in  the  network  may  cause  the 
entire  network  to  crash.  This  may  create  problems  that  are  more  difficult  to  detect  than 
when  one  node  on  a  common  bus  is  malfunctioning  [4], 

A  token  bus  network  is  very  similar  to  a  token  ring  network  in  that  a  token  is 
passed  fi'om  node  to  node  in  a  virtual  ring.  The  nodes  are  actually  connected  by  a 
common  bus  so  each  message  is  sent  to  all  the  nodes  before  the  next  message  is  sent.  This 
requires  a  great  deal  more  time  than  the  process  of  direct  token  passing  in  a  token  ring 
network.  It  is  superior  in  that  if  one  node  fails  the  network  may  still  function  [4], 

In  the  binary  countdown  protocol,  each  node  waits  for  a  clear  channel  before 
transmitting.  Each  node  is  assigned  a  certain  binary  number  corresponding  to  the  priority 
of  the  traffic  it  sends.  When  h  transmits,  the  node  first  sends  this  information  on  the  bus. 
Two  nodes  attempting  to  transmit  at  the  same  time  resolve  their  conflict  by  sending  out 
one  bit  at  a  time  of  their  assigned  number  to  determine  which  message  has  priority. 
TypicaUy,  a  binary  1  indicates  a  higher  priority  than  a  binary  0.  For  example,  imagine 
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three  nodes  with  priorities  110,  1 1 1,  and  010  attempting  to  transmit  at  the  same  time. 

They  each  transmit  their  first  bit,  and  the  network  sees  that  two  are  transmitting  1  ’s  so  it 
locks  out  the  010  node  because  its  traffic  has  a  lower  priority.  It  then  continues  checking 
tile  bits  of  the  remaining  nodes  until  it  reaches  a  point  where  all  nodes  are  locked  out  but"^ 
protocol,  also  called  the  bit  dominance  protocol,  is  used  infi-equently  because  of 
the  difficulty  in  adding  new  nodes  and  the  required  complexity  of  the  connections  [4]. 

The  CSMA/CD  protocol  allows  an  almost  unlimited  number  of  nodes  connected 
on  a  common  bus.  New  nodes  may  be  added  or  deleted  without  new  initialization.  Each 
node  sunply  sends  a  message  across  the  bus  when  it  needs  to.  If  two  nodes  anempt  to 
transmit  at  the  same  time  a  colhsion  occurs.  Analog  circuitiy  detects  this  colhsion,  and 
each  node  transmits  its  data  again  after  a  period  of  time.  This  protocol  is  very  inefficient 
under  heavy  traffic  conditions,  and  its  determinacy  is  very  poor  since  multiple  colhsions 
may  keep  occurring,  effectively  fi-eezing  the  network.  Ethernet,  the  popular  data  network 
protocol  is  based  on  this  protocol.  Very  similar  is  the  CSMA/CA  protocol  which 
combines  facets  of  the  CSMA/CD  and  TDMA  protocols  [4]. 


2.2  Serial  Communication 


Whatever  protocol  is  used  in  the  network,  there  must  also  be  a  standard  for 
communication  of  information  between  the  nodes.  Fortunatelv.  there  are  several 
^andards  to  which  most  existing  appUcations  adhere.  There  are  still  however,  choices  to 
be  mnde  when  dealing  with  intercomputer  communications. 

fi  •  different  methods  by  which  one  can  communicate  information  The 

hrst  IS  caUed  paraUel  communication.  In  paraUel  communication,  whole  words  of 
mfoi^tion  are  sent  at  one  time  fi-om  one  computer  to  another.  A  computer  word  is 
usuaUy  8  or  16  bits  long  so  two  computers  would  need  8  or  16  connections  for  one  to 
trmsmit  a  word  in  parallel.  Serial  transmission,  on  the  other  hand,  sends  out  one  bit  of 
information  at  a  time  mstead  of  one  byte  at  a  time.  Therefore,  only  one  data  path  is 
required  between  nodes.  There  are  several  advantages  and  disadvantages  to  both.  Parallel 
commumcation  is  much  faster  than  serial  communication  since  information  is  essentiallv 
moving  eight  times  as  fast.  There  is  a  price  for  this  speed  increase,  however.  Eight  times 
as  n^y  connections  are  required  between  computers.  This  can  become  buUcv  a^d  verv 
costly  ey  eciaUy  m  a  noisy  environment  where  a  quahty  medium  such  as  fiberoptic  cable 
is  used.  In  general  paraUel  communication  is  reserved  for  shon  paths  such  as  nodes  in  the 
same  room,  whereas  serial  communication  is  more  practical  for  longer  distances  such  as 
tiiose  between  nodes  in  a  typical  control  network. 

The  problem  with  transmining  information  seriaUy  is  that  since  there  is  only  one 
ata  path  for  information  to  travel  a  large  number  of  bits  must  travel  along  the  same  wire 
at  different  times.  This  results  m  a  problem  if  the  receiving  node  misses  one  or  more  of 
the  bits  in  the  transmission  process  and  then  decodes  the  message  incorrectlv  On  a 
broader  note,  the  recehdng  node  must  know  when  the  first  bit  of  the  message  is  going  to 
e  sent.  The  communications  interface  can  accompUsh  this  in  two  ways.  First,  the 
processors  can  apee  that  the  transmission  wiU  occur  at  a  specific  time,  every  n^second 
or  example.  This  requires  that  one  of  the  processors,  termed  a  master  node,  provide  a 


9 


clock  signal  to  the  slave  node  and  send  or  receive  data  on  the  rising  or  falling  edges  of  this 
clock.  This  is  called  synchronous  transmission.  The  other  way  for  the  receiving  node  to 
know  data  is  coming  is  for  the  transmitting  node  to  send  a  start  bit  immediately  prior  to 
sending  data.  The  processors  here  do  not  necessarily  need  to  be  running  at  the  same  clock 
speed,  but  must  be  capable  of  operating  at  a  common  speed  (i.e.,  at  the  lower  of  the  two). 
This  is  known  as  asynchronous  transmission.  Because  of  the  fewer  connecting  \vires  that 
it  requires,  asynchronous  transmission  is  more  practical  over  long  distances,  and  therefore 
more  widely  used  in  network  applications. 

As  mentioned,  asynchronous  serial  transmission  works  by  one  processor  signaling 
another  with  a  start  bit  that  it  is  going  to  begin  transmitting.  This  start  bit  is  typically  a 
low  state.  The  other  processor,  which  knows  how  fast  the  information  is  coming  and  how 
many  bits  of  data  are  coming  at  a  time  (usually  eight),  reads  each  bit.  After  aU  of  the  data 
bits  are  transmitted,  the  transmitting  processor  sends  a  stop  bit  of  opposite  state  as  the 
start  bit  to  let  the  receiver  know  the  transmission  is  complete.  This  stop  bit  lasts  for  an 
indefinite  period,  with  a  minimum  time  specification  to  allow  the  receiving  computer  time 
to  store  data  before  the  next  byte  arrK'es.  These  ten  or  so  bits  of  information-the  start  bit. 
data  bits,  and  stop  bit-are  known  as  a  fi'ame  [5],  A  typical  fi'ame  is  shown  in  Figure  2. 1 
below. 


1 

0 


8-bit  character 


stop  bit  _  stop  bit 


start  bit 


Figure  2.1.  A  Sample  Frame 

If  the  start  bit  or  stop  bit  are  not  received  correctly,  a  framing  error  occurs.  The 
receiver  throws  out  the  entire  character  because  it  could  not  be  sure  it  received  the  right 
data.  TTiis  may  not  be  the  end  of  the  problem,  however.  If  a  start  bit  is  received 
incorrectly  as  a  high  instead  of  low,  the  first  bit  of  data  that  is  low  will  be  assumed  to  be 
the  start  bit  and  the  wrong  character  will  be  sent.  This  usually  happens  if  a  ghtch  on  the 
line  generates  a  false  start.  If  the  bit  after  the  stop  bit  is  also  high,  the  receiver  will  think 
this  data  is  vahd  and  accept  it.  This  is  known  as  a  synchronization  error. 

There  are  many  other  errors  that  can  occur  as  a  result  of  garbled  transmissions.  If 
one  of  the  data  bits  is  not  transmitted  properly,  the  receiver  will  simply  receive  one  bad 
character.  This  is  known  as  a  single  bit  error.  One  way  to  catch  this  error  is  by 
performing  a  character  parity  check  [5].  In  a  parity  check,  a  parity  bit  is  transmitted 
immediately  after  the  data  bits  and  tells  whether  there  were  an  even  or  odd  number  of  1  ’s 
in  the  data.  The  receiver  looks  at  the  data  and  calculates  this  value  also  and  then 
compares  its  result  with  the  parity  bit.  This  is  one  of  the  simplest  error  checking 
protocols,  but  also  one  of  the  most  commonly  used.  A  single  parity  bit  will  detect  an  odd 
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number  of  bit  errors,  but  cannot  determine  which  bits  were  in  error.  It  is  often  called  a 
“single-error”  detecting  scheme.  It  is  impossible  to  detect  all  possible  sources  of  error, 
but  it  is  important  to  realize  that  any  communication  error  may  result  in  a  momentary  or 
total  failure  of  the  control  network. 


2.3  DC  Motors 

A  DC  motor  is  a  device  that  converts  electrical  energy  to  mechanical  energy  by 
current  flowing  through  a  magnetic  field.  A  model  of  a  DC  motor  is  shown  below  in 
Figure  2.2.  The  components  La  and  Ra  represent  the  inductance  and  resistance  of  the 
armature,  respectively. 


Figure  2.2.  A  Model  of  a  D.C.  Motor 


As  the  applied  voltage  Vu,  increases,  the  current  that  flows  through  the  armature 
increases  as  weU.  Since  a  direct  relationship  exists  between  the  armature  current  and  the 
output  torque  of  the  motor,  this  will  cause  an  increase  m  motor  velocity  as  well.  This  is 
typically  how  a  DC  motor  is  controlled  —  by  varying  the  voltage  apphed  to  its  armature. 
This  may  be  done  with  a  transistor  or  rheostat.  The  problem  with  this  is  when  the 
transistor  operates  in  its  linear  region.  If  the  motor  is  to  nm  at  half  the  applied  power,  the 
other  half  of  the  power  must  be  dropped  across  the  transistor  and  therefore  wasted  [6]. 

A  better  way  to  control  the  voltage  applied  to  a  DC  motor  is  by  using  the 
transistor  merely  as  a  switch  and  sending  a  pulsewidth  modulation  (PWM)  signal.  The 
PWM  signal  can  be  varied  in  duty  cycle  to  send  a  fi'action  of  the  power  to  the  motor 
without  wasting  any  power.  Instead  of  half  the  power  being  sent  to  the  motor  and  half 


dissipated  across  the  transistor,  the  full  power  of  tlie  battery  is  sent  to  the  motor  for  half 
the  time. 

The  theory  behind  the  PWM  signal  is  the  Fourier  Transform  By  analyzing  a  train 
of  pulses  with  frequency  f  =  fo,  we  obtain  the  frequency  domain  spectra  shown  in  Figure 

2.3  (a).  As  can  be  seen,  the  signal  contains  a  DC  value  (which  happens  to  be  equal  to  the 
average  value  of  the  function)  and  discrete  values  at  whole  number  multiples  of  the 
frequency  of  the  pulse  train.  A  motor  acts  as  a  first  order  low  pass  filter  (shown  in  Figure 

2.3  (b)  below)  and  removes  any  frequencies  higher  than  its  cutoff  frequency,  t.  What  is 
left,  assuming  ft)  is  greater  than  ft;,  is  a  single  DC  value  equal  to  the  average  value  of  the 
pulse  train.  The  inverse  Fourier  Transform  of  this  is  simply  a  step  function  of  height  equal 
to  the  DC  value.  This  step  function  then  drives  the  motor  as  if  a  constant  voltage  equal  to 
the  \  alue  of  the  step  fimction  were  apphed  directly. 


Pulse  Frequency  Spectrum 


Motor  Frequency  Response 


Figure  2.3.  Frequency  Speara  of  PWM  Signal  and  Motor  Response 


An  equally  important  consideration  as  controlling  the  speed  of  the  motor  is 
controUing  its  direction.  This  involves  four  switching  devices  set  up  in  an  H-bridge 
configuration,  with  two  being  turned  on  at  any  one  time.  Fortunately  there  exists  several 
H-bridge  motor  drivers  with  this  circuitry  built  in.  All  of  these  drivers  are  fairly  similar  in 
terms  of  the  signals  required  to  control  them  Each  requires  a  power  source  (usually  12- 
24  V)  and  ground  as  well  as  a  Phase  and  Enable  signal  The  phase  signal  tells  the  motor 
driver  which  direction  the  motor  will  turn,  and  the  enable  signal  allows  the  power  signal  to 
be  connected  to  the  motor  armature,  i.e.,  enables  the  motor  to  run. 

There  are  two  ways  to  drive  a  motor  in  this  fashion.  The  first,  called  the 
sign/magnitude  mode  uses  the  Phase  bit  to  determine  direction  and  the  Enable  bit  to 
determine  speed.  In  this  mode,  the  PWM  signal  is  sent  to  the  Enable  bit.  The  duty  cycle 
of  the  PWM  signal  determines  the  DC  value  sent  to  the  motor.  It  can  vary  over  its  fid! 
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resolution,  controlling  the  speed  from  full  on  (100%  duty  cycle)  to  full  oflf  (0%  duty 
cycle).  The  motor  is  thus  only  turned  on  as  needed  [6], 

The  alternate  mode  is  the  Locked  Antiphase.  In  this  mode,  the  Enable  signal  is  left 
at  high-the  motor  is  “full  on.”  What  is  varied  using  PWM  is  the  Phase  or  direction  signal. 
A  PWM  input  of  50%  duty  cycle  will  enable  the  motor  half  the  time  in  each  direction  at 
fidl  speed,  thereby  canceling  one  another.  Any  PWM  duty  cycle  greater  that  50%  will 
cause  the  motor  to  turn  in  the  positive  direction,  with  100%  duty  cycle  causing  the  motor 
to  actually  turn  at  full  speed  in  the  positive  direction.  The  same  is  true  for  the  negative 
direction  in  the  lower  half  of  the  PWM  values.  The  advantage  of  this  method  is  that  full 
torque  always  exists  on  the  motor.  This  allows  the  motor  to  respond  quickly  to  a  change 
in  commanded  velocity.  The  disadvantage  is  that  this  method  has  only  half  the  resolution 
of  the  sign/magnirude  mode  since  the  duty  cycle  ranges  only  50%  from  full  off  to  full  on. 
Also,  ^eater  power  consumption  results  because  current  is  always  flowing,  even  when  the 
motor  is  stopped.  The  reason  for  this  effect  is  that  the  Enable  bit  is  always  set.  This 
effectively  sends  no  information  to  the  motor  driver,  where  before,  the  setting  or  clearing 
of  the  Enable  bit  determined  the  speed  of  the  motor  [6]. 


2.4  Microcontrollers 

For  embedded  applications  there  are  several  choices  of  microprocessors  for  use. 
but  they  can  essentially  be  divided  into  two  groups:  1 )  microprocessors  from  makers  such 
as  Intel  or  Motorola,  which  are  adapted  by  third  party  vendors  for  use  in  embedded 
applications  and  2)  dedicated  microcontrollers  which  are  not  capable  of  running  an  entire 
PC.  The  real  division  between  a  microprocessor  and  a  microcontroller  is  that  the  former 
requires  external  RAM  and  ROM  to  be  added  while  the  latter  aheady  possesses  required 
memory  on  a  single  chip.  Each  has  its  own  advantages  and  disadvantages. 

The  Intel  80x86  family  of  microprocessors  is  the  same  line  which  make  up  the 
heart  of  most  personal  computers  in  the  world.  These  are  very  powerfiil  and  can  often  be 
run  at  clock  speeds  exceeding  100  MHz.  They  also  possess,  in  their  embedded  mode, 
capabihty  to  perform  many  of  the  same  fimaions  as  when  thev  run  a  PC.  For  example 
many  include  connections  for  a  floppy  disk  or  VGA  display.  Another  advantage  is  that 
famihar  compilers  that  run  on  PC’s  wiU  compile  programs  for  these  embedded  processors 
as  well.  This  often  saves  the  user  from  having  to  learn  another  language  for  his  embedded 
applications.  The  main  disadvantage  of  such  chips  is  the  high  cost.  Most  are  in  the  range 
of  $400  to  $600.  For  a  multi-node  network,  this  can  quickly  make  a  project  unfeasible.'' 
T^e  boards  on  which  the  Intel  or  Motorola  dedicated  chips  come  are  also  very  bulky  in 
size.  This  is  because  the  Intel  chip  itself  is  only  a  microprocessor  and  needs  supporting 
chips  such  as  A/D  converters  and  display  adapters.  FinaUy,  it  is  difficult  to  exploit  the'fiill 
potential  of  an  Intel  computer  in  embedded  applications.  Ihis  often  makes  the  high  cost 
not  very  worthwhile. 

Compared  to  the  Intel  line  of  microprocessors,  dedicated  microcontrollers  seem  at 
first  severely  lackmg  in  power.  Their  maximum  clock  speeds  usually  do  not  exceed  25 
3  hit  nusleading,  however.  With  careful  assembly  language  programming, 
they  can  often  run  the  same  operations  as  a  more  powerful  computer  in  fewer  instructions. 
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Most  are  also  typically  smaller  than  comparable  Intel-based  microcontrollers,  with  the 
smallest  taking  up  no  more  space  than  a  single  chip.  Tliis  makes  these  dedicated 
microcontrollers  much  more  desirable  for  space-conscious  apphcations.  They  also 
typically  cost  less  than  one  tenth  the  amount  of  Intel  microprocessors,  making  them  a 
good  choice  for  applications  requiring  many  nodes. 

At  this  time,  one  of  the  best  of  these  microcontrollers  is  the  Peripheral  Interface 
Controller  (PIC)  family  of  microcontrollers.  The  PlClbCxx  series  is  representatwe  of  a 
new  breed  of  microcontroller.  These  particular  devices  are  18-  to  40-pin  chips  and  require 
only  one  external  cry'stal  oscillator  to  become  fully  functioning  computers.  The  RISC 
(Reduced  Instruction  Set  Computer)  architecture  contains  only  35  single-word 
instructions,  each  of  which  executes  in  one  clock  cycle  (except  the  branching  instructions 
such  as  “goto”  and  “call”  which  require  two  cycles).  The  speed  and  simplicity  of  this 
design  makes  these  processors  ideal  for  high-speed  control  apphcations.  In  addition,  this 
particular  family  of  processors  includes  several  varieties  which  have  onboard  analog-to- 
digital  (AT))  capabihty,  thus  further  increasing  their  usefulness  in  the  control  field.  Often, 
control  problems  require  that  analog  data  be  collected  and  control  actions  be  based  upon 
such  data.  The  PIC16C71  and  PIC16C74  are  ideal  for  such  apphcations.  Each  has  a 
single  A/D  unit  which  is  multiplexed  to  multiple  pins  on  the  chip,  thus  allowing  sequential 
reading  of  four  or  eight  analog  values,  respectwely.  The  PIC16C71  operates  on  a  16 
MHz  clock  fi'equencv,  executing  each  instruction  in  250  ns  and  is  capable  of  A/D 
conversions  at  the  rate  of  30  kHz.  TTie  PIC16C74  operates  at  20  MHz  and  has  an  A/D 
converter  which  can  perform  62,500  conversions  per  second  ( 16  p.s  each)  [7].  These 
processors  range  in  price  fi'om  approximately  SIO  to  S50  and  are  the  processors  chosen 
for  this  research. 


2.5  Image  Processing 


An  image  is  defined  as  a  ‘two-dimensional  hght  intensity  function _/(XjVT  where  x 
and  V  denote  spacial  coordinates  and  the  value  off  at  any  point  (x.j)  is  proportional  to  the 
brightness  (or  gray  level)  of  the  image  at  that  point”  [8],  Images  are  analog  in  nature,  the 
brightness/ may  take  on  any  value  at  any  point  and  the  difference  betvs  een  the  values  at 
different  points  may  be  infinitely  small.  To  make  image  data  useful  to  computers,  an 
image  must  be  discretized  or  digitized  so  that  information  about  the  brightness  at  any 
point  can  be  communicated  digitally  to  the  computer.  The  result  of  this  operation  is 
known  as  a  digital  image. 

A  digital  image  processor  is  the  core  of  an  image  processing  s}'stem  and  contains 
components  that  perform  four  basic  functions-image  acquisition,  storage,  low-level 
processing,  and  display.  The  module  responsible  for  acquiring  and  digitizing  the  image  is 
known  as  a  fi'ame  grabber,  so  named  because  modem  image  processors  are  capable  of 
digitiring  a  TV  image  in  one  fi-ame  time  [9].  The  image  data  are  then  stored  in  memory 
called  a  frame  buffer.  From  here  a  processing  module  performs  low  level  arithmetic  and 
logic  operations  on  the  image  before  it  is  sent  to  the  display  device. 

A  digitizer  divides  the  two  dimensional  image  into  an  array  of  pixels,  thereby 
discretizing  the  number  of  possible  coordinates  x  andy.  Each  digital  coordinate  is  known 
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as  a  pixel.  In  order  to  speed  calculations,  the  array  is  often  square  with  the  number  of 
rows  and  columns  being  a  power  of  two,  for  example  512X512  pixels.  The  image  is 
further  discretized  in  the  niunber  of  brightness  levels  allowed  each  pixel.  This  also 
typically  is  a  power  of  two.  A  binary  image  is  a  digital  image  with  only  two  brightness 
levels-0  and  1.  With  the  smallest  amount  of  information  per  pixel  a  binary  image  is  the 
simplest,  yet  lowest  clarity  digital  image.  It  is  essentially  a  black  and  white  image,  with  no 
other  gray  levels.  A  256  gray  level  image,  on  the  other  hand,  contains  much  more 
information  per  pbcel  and  is  therefore  much  clearer.  It  however  requires  more  storage  and 
communication  time  to  make  use  of  this  data. 

The  image  on  which  a  frame  grabber  operates  is  Ae  output  of  a  camera.  Both 
VTDICON  and  Charged  Coupled  Device  (CCD)  are  common  with  the  latter  being 
preferred  due  to  size  and  weight.  The  camera  is  capable  of  sending  analog  information 
out  one  wire  at  speeds  sufficient  to  display  without  flickering.  The  information  is  sent  line 
by  Une  with  all  the  odd  lines  being  sent  and  then  all  the  even  lines  following.  This  is 
known  as  interlaced  scanning  [10].  Between  each  line  a  0-V  horizontal  sync  pulse  is  sent 
to  let  the  unage  processor  know  a  new  line  is  coming  After  a  complete  picture  has  been 
scanned,  a  longer  vertical  sync  pulse  is  sent  to  indicate  the  completion  of  a  frame. 
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3.  Dynamics  and  Control 

Ih  order  for  a  control  system  to  be  developed  for  the  specific  application,  a 
complex  study  of  the  physical  system  is  necessary.  There  are  several  ways  of  doing  this. 
For  example,  the  motor  may  be  given  a  step  input  and  have  its  output  measured.  This 
might  give  a  fairly  accurate  system  model.  A  different  approach  is  to  obtain  a  mode  by 
modeling  the  dynamics  of  the  system  itself  However,  because  this  s>'stem  is  highly 
nonlinear,  this  may  prove  problematic. 

One  solution  to  the  trouble  of  modeling  nonlinear  equations  is  to  make  use  of 
Lagrange’s  method,  which  uses  the  concept  of  potential  and  kinetic  energy  instead  of 
forces.  Because  of  the  amount  of  mathematical  calculations  required  by  this  method,  it  is 
convenient  to  use  a  computer  to  find  the  solution.  In  Appendix  Al,  a  MATLAB  program 
for  calculating  the  sx'Stem  dynamics  is  shown.  By  appKing  Lagrange's  method  to  the 
sx'stem  at  hand,  assuming  the  marble  rolls  without  slipping  and  the  angular  velociu’  of  the 
track  has  a  negligible  effect  on  the  velociU'  of  the  marble,  the  following  system  of 
equations  is  obtained. 

-  BxX  -=11  5m\x  -  m\x6‘  -  m\g  cos(^)  (3.1) 

BoB-  2m\x6x +  {mx‘  +  \l2rmL‘')B-m\gx-cjos{6)  (3.2) 


where; 

m\  =  mass  of  ball 
=  mass  of  beam 

Bi  =  linear  damping  coefficient  of  ball 
Be  =  angular  damping  coefficient  of  beam 
Tm  =  motor  torque 
X  =  linear  position  of  ball 
X  =  linear  velocity  of  ball 
X  =  linear  acceleration  of  ball 
6  =  angular  position  of  beam 
9  =  angular  velocity  of  beam 
9  =  angular  accelaeration  of  beam 


As  can  be  seen,  these  equations  are  both  nonlinear,  which  makes  them  very 
difficult  to  use  in  any  attempt  to  develop  a  control  solution.  The  equations  can,  however, 
be  linearized.  By  examining  values  that  the  state  variables  are  most  likely  to  take, 
approximations  can  be  made  which  will  allow  for  four  linear  state  equations  which  are  an 
accurate  model  for  the  nonlinear  system.  In  order  to  linearize  the  system,  the  amount  of 
accuracy  is  determined  by  how  many  values  the  state  variables  are  allowed  to  take.  For 
example,  one  linearization  would  assume  9  ~  0 ,  for  the  purposes  of  simplification  since 
the  track  is  not  expected  to  turn  at  great  angles.  This  would  allow  changes  to  be  made  to 
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the  above  equations  that  remove  nonlinearities  (for  example,  the  cos(^)  m  (3. 1)  becomes  a 
constant  value  of  1.  Another,  more  complex  linearization  algorithm  might  have  several 
values  that  the  state  variables  may  take  on  and  use  a  lookup  table  for  each  value. 

Whatever  system  is  being  used,  it  is  important  to  note  that  if  the  actual  variables  take  on 
values  too  diflFerent  from  the  assumptions,  the  \vhole  linear  model  becomes  useless. 

For  this  specific  problem,  both  position  and  angular  position  variables  are 
linearized  about  0.  This  is  legitimate  since,  as  mentioned  earlier,  the  track  should  not  turn 
at  a  great  angle.  Also,  the  position  will  never  be  more  than  .5  meter  in  either  direction 
since  the  beam  is  only  one  meter  long.  A  few  other  assumptions  must  be  made  in  order  to 
completely  Unearlze  the  system.  Since  angular  velocity  is  expected  to  be  rather  small  any 

term  with  6  is  assumed  to  be  zero  as  well.  By  making  these  assumptions,  a  linear  state 
matrix  can  be  created.  This  matrix  is  shown  in  (3.3). 


X 


X 

e 

6 


0 

1 

0 

0 

X 

0 

0 

0 

-55x  /  7m. 

5g/7 

0 

X 

+ 

0 

0 

0 

1 

e 

0 

m\g  /  D 

0 

0 

-Bo!  D_ 

e_ 

_1/D_ 

where:  D  =  mzL:il 


(3.3) 


Once  a  state  matrix  is  formed,  a  control  solution  can  be  begun  using  MATLAB. 
The  simplest  way  to  accomplish  this  is  by  using  an  integral  plus  gain  state  feedback  design. 
A  model  of  this  design  is  given  below,  m  Figure  3. 1 


Figure  3.1.  State  Feedback  Integral  Design 
The  integrator  will  assure  that  the  error  goes  to  zero  even  if  there  are  variations 
between  the  actual  system  and  the  modeled  system.  Appendix  C  shows  a  MATLAB 
program  written  to  perform  this  function.  By  adjusting  only  one  line  in  the  program,  a  set 
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of  desired  poles  can  be  chosen.  Changing  these  poles  should  change  the  step  response  of 
the  system.  Since  no  overshoot  at  all  is  acceptable  in  the  case  when  the  marble  is  directed 
to  move  near  the  end  of  the  beam  (if  any  overshoot  e>dsted,  the  marble  would  fall  off  the 
track),  poles  near  the  origin  are  chosen  initially.  The  program  has  the  capability  to  allow 
the  user  to  print  these  gains  in  a  binaiy'  file  which  may  be  used  as  a  source  of  input  data  to 
the  PC  running  in  the  network.  This  will  allow  the  user  to  change  the  poles  using 
MATLAB  and  wimess  immediately  the  effect  of  the  new  gains  on  system  response. 

In  order  to  test  both  the  accuracy  of  the  linear  model  as  well  as  the  effectiveness  of 
the  pole  placement  on  step  response,  it  is  necessary  to  simulate  the  acmal  system  This  is 
accortqjhshed  using  Simulink,  a  program  which  runs  fi'om  within  MATLAB  that  can 
accept  data  from  MATLAB.  Here,  the  actual  nonlinear  system  is  simulated  according  to 
the  equations  obtained  using  Lagrange’s  method.  At  the  same  time,  the  linear  model  was 
simulated,  and  the  same  input  was  apphed  to  both  systems.  The  results  of  this  are  shown 
in  Figure  3.2.  where  the  response  to  both  the  linear  and  nonlinear  s^'stems  are  plotted  on 
the  same  graph. 

The  approximated  linear  response  is  very  similar  to  the  expected  actual  response 
from  the  s\'stem  This  means  that  the  assumptions  made  w'hen  linearizing  the  s>'stem  were 
good  ones.  TTie  responses  are  also  acceptable  in  terms  of  overshoot  and  settling  time. 

This  indicates  that  the  poles  selected  were  also  a  good  choice.  The  required  input  torque 
can  also  be  plotted  using  the  data  from  Simulink  and  M,A.TLAB.  Figure  3.3  shows  the 
torque  of  the  motor  in  both  the  linear  approximation  and  nonlinear  model.  Again,  there  is 
a  very  good  relationship  between  the  two.  What  remams  to  be  seen  is  whether  the  motor 
is  capable  of  exerting  this  much  torque. 

If  different  poles  are  chosen  by  the  user,  the  position  graphs  began  to  differ.  For 
exanple,  if  the  poles  are  moved  to  speed  the  peak  time  up,  two  things  happen.  First,  the 
overshoot  reaches  an  unacceptable  level  (this  is  expected).  What  is  not  expected  is  the 
much  larger  difference  between  the  modeled  response  and  actual  response.  This  indicates 
that  the  s\’stem  was  forced  past  the  point  where  the  linearization  assumptions  were  vahd. 

If  the  user  really  wanted  to  make  use  of  this  pole  placement,  the  entire  linear  model  would 
need  to  be  changed.  Fortunately,  the  desired  response  from  Figure  3.2  remains  within 
these  parameters.  These  state  feedback  gains  seem  therefore  a  good  choice  for  the  design. 


position  (meters) 
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Figure  3.2.  Position  Response  Comparison  of  Linear  and  Nonlinear  Models 


4.  Token  Passing  and  Network  Protocol 
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By  far  the  most  in^ortant  aspect  of  the  project  is  developmg  a  message  passing 
protocol  that  will  be  successful  in  a  generalized  control  network.  T^e  protocol  primarUy 
must  assure  that  each  node  that  needs  to  send  data  will  have  some  chance  to  send  it. 
Secondly,  it  must  allow  for  the  most  desirable  transmission  of  data  possible.  Desirabihtv 
varies  depending  on  the  network  properties  that  the  application  requires  and  includes  such 
factors  as  ^eed,  eflSciency,  and  determinacy.  FinaDy,  any  protocol  should  consider  that 
future  additions  may  someday  be  made  and  maintain  a  flexibihty  to  handle  these  additions. 

With  these  factors  in  mind,  the  actual  network  must  be  examined.  The  heart  of 
any  network  is  the  message  passing  protocol.  As  mentioned  earlier,  a  token  ring  network 
IS  sunply  a  group  of  microprocessors  connected  in  series,  with  each  microprocessor 
directly  connected  only  to  two  others.  The  first  message  sent  is  a  startup  message  and 
must  be  initiated  by  the  user.  After  this,  the  network  is  constantly  nmning  itself,  with 
messages  being  passed  fi-om  one  node  to  another,  whether  or  not  they  contain  actual  data. 
If  one  node  has  a  message  to  send,  it  waits  for  a  token  which  indicates  the  network  is  free 
and  then  grabs  the  token  and  sends  its  message.  The  message  is  coded  for  the  address  that 
IS  meant  to  receive  the  message  so  that  if  there  are  any  nodes  between  the  sender  and 
recewer,  they  will  recognize  that  the  message  is  not  for  them  and  pass  it  on.  When  a  node 
receives  a  message  that  is  addressed  to  it,  it  will  read  the  message  and  perform  the 
operation  indicated.  It  may  then  send  a  message  of  its  own  or  send  a  token,  depending  on 
whether  It  has  something  to  say  or  not.  This  process  is  repeated  ad  infinitum.  If  a  poi^t  is 
ever  cached  where  not  a  single  node  has  a  message  to  transmit,  then  tokens  will  still  be 
passed  from  one  node  to  another  continuouslv. 

The  communications  format  for  the  messages  is  a  standard  serial  9600  baud  (bits 
per  second)  transfer.  Each  of  the  nodes  communicates  information  bv  passing  several 
bvtes  of  data  one  bit  at  a  time  over  two  wires  (one  wire  contains  the  ^formation  and  the 
other  IS  a  common  ground).  One  byte  (or  character)  consists  of  8  bits  of  information, 
bach  bit  of  information  is  assigned  either  the  value  1  or  0.  Depending  on  the 
conmumcation  standard  used,  the  bit  values  are  assigned  a  voltage  level.  For  e.xample,  in 
IT  standard,  by  which  most  PC’s  communicate,  a  1  is  assigned  the  value  of 

-12  V,  and  a  0  IS  assigned  the  value  of +12  V.  The  standard  used  b  the  network  of  PIC 
processors  by  necessity  needs  to  rely  on  TTL  voltage  levels.  Thus,  a  0  is  assigned  the 
value  of  0  V,  and  a  1  the  value  of +5  V.  A  sample  byte  is  shown  below  in  Figure  4. 1. 


I  |o  li  li  k)  |i  |o 


Figure  4.1,  A  Sample  Character 

This  character  may  be  represented  as  the  binary  number  1 0 1 1 0 1 0 1 2.  This  number 
may  then,  for  the  sake  of  convenience,  be  convened  to  its  equivalent  decimal 
representation,  in  this  case  181.  Using  this  convention,  then,  each  byte  of  every  message 
IS  a  decimal  number  fi-om  0  to  255  (00000000.  to  1 1 1 1 1 1 1 1.).  As  mentioned  before,  ^ 
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each  message  consists  of  two  or  more  bytes  of  information  communicated  serially  across 
one  wire. 

The  way  that  each  node  generates  these  characters  varies  slightly  because  each 
node  has  different  capabilities.  They  all  generate  the  same  characters,  just  in  a  different 
format.  The  asynchronous  serial  communications  format  used  is  identical  to  the  one  used 
by  PC’s  with  the  exception  of  the  aforementioned  voltage  shift.  Each  character  is 
transmitted  one  bit  at  a  time  with  the  least  significant  bit  transferred  first.  This  complies 
with  the  RS-232  standard  for  personal  computers.  Figure  4.2  shows  how  the  above 
sample  character  would  be  transmitted.  One  can  see  that  following  the  start  bit,  the  data 
transferred  bit  by  bit  is  10101101.  Comparing  this  to  the  sample  byte  reveals  that  the  data 
is  reversed  because  the  least  .significant  digit  was  indeed  transferred  first.  This  is  no 
problem  because  the  receiving  node  simply  shifts  the  data  in  from  left  to  right,  which  shifts 
the  first  character  to  the  rightmost  bit  and  each  successK'e  character  one  bit  to  the  left. 

8-bit  character 


^  stop  bit  _  _  _  _ stop  bit 

0  I - 1  I - 1  I - 1  I - 

start  bit 


Figure  4.2.  Transmission  of  a  Character 


The  method  by  which  each  node  generates  serial  communications  also  depends  on 
the  spectSc  hardware.  Two  of  the  three  PIC  processors  serving  as  nodes  in  the  network 
are  powerful  PIC  16C74's  with  serial  communication  built  into  the  hardware.  This  means 
that  all  that  is  required  to  transmit  data  is  simply  to  load  a  register  called  TXREG  with  the 
8-bit  character  that  is  to  be  sent.  Then,  by  setting  a  few  control  registers  to  govern  the 
baud  rate  and  enabling  transmission,  the  data  wifi  be  sent  out  at  the  appropriate  speed,  and 
the  processor  can  be  signaled  with  an  interrupt  when  one  byte  is  finished  transmitting. 

The  program  can  then  proceed  to  the  next  byte  in  the  same  fashion. 

The  node  that  controls  the  LCD  display  and  communicates  with  the  PC  is  the  less 
powerful  PIC  1 6C84.  This  processor  does  not  possess  on-board  serial  communications 
hardware.  In  order  for  it  to  transmit  the  information,  it  must  set  and  clear  the  transmit  pin 
itself  according  to  the  data  desired  to  be  sent.  The  processor  must  also  consider  the 
timing  involved.  Depending  on  the  speed  of  the  crystal  oscillator  being  used  to  drive  the 
PIC  (in  this  case  1 1.0592  MHz),  the  program  must  delay  for  the  appropriate  number  of 
instruaion  cycles  to  assure  that  the  time  each  bit’s  value  is  placed  on  the  transmit  line  is 
1/9600  second,  or  0. 1 04  millisecond.  If  this  proper  timing  is  not  observed,  nodes  with 
standard  communications  interfaces  will  interpret  the  messages  as  garbage  and  ignore 
them  To  accomplish  this  the  PIC16C84  uses  a  timing  loop,  where  a  register  is 
decremented  every  three  instructions.  When  this  register  reaches  zero,  the  processor 
sends  the  next  bit  of  data. 
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The  same  timing  loop  must  be  used  when  the  PIP  i  fir  ♦ 

In  this  case,  the  processor  interrunts  whpn  Jtc  •  i-  receive  a  message. 

Stan  bit).  Tie  processor  ttel  d7vs  for  hatf  of  ,bT  '  «  o'”™* 

again  just  to  make  sure  the  first  check^was  nof  ^'il  bit 

processor  then  delays  for  one  fiill  bit  time  tak’  actual  stan  bit,  the 

reads  foe  value  on  L  ^  1  ^  '' •>«  Here,  i. 

•hen  rerums  .0  Is  main  pro.mam  Sofot  SaaeT'  rea^M 

U^ee  secrioTSrcSudr  tao 

firs,  character  sen.  is  foe  addrerof  foe  „d  t  ^  'T‘‘ Tie 
node  to  quickly  teU  whefoer  a  messaae  it  has  f “nt.  This  allows  a 
thoroughly  or  passed  on  to  foe  next  iode  Th  ““re 

address  of  foe  node  that  sent  foe  messane  Thk“”h'^k^’'*  fir' 

receding  node  needs  to  send  a  return  .issa»e  “ioimatiou  in  case  foe 

to  execute.  For  example,  if  one  node  wanterf  '^ti,  ^  ^be  receaing  node  is 

third  byte  of  the  message  would  be  00000101  Ta  its  fifth  command,  the 

commands  will  be  expbined  below  Zer  tS  'cn^  T 
data  that  is  necessary  for  the  receivin^^de  to  ex^ 

node  will  know  what  command  it  is  telling  the  Zl  command.  TTie  sending  ' 

be  able  to  send  the  appropriate  data  if^v  se^m  °  ^  therefore 

way.  and  perhaps  it  is.  One  mav  wonder  whv  the  transmit  commands  in  this 

of  the  message  instead  of  just  n[imbers  tellinJthe  cannot  be  sent  as  pan 

command  to  execute.  The  reason  that  th'  ■"  ^  ttode  which  predefined 

m  the  PIC  processor.  After  its  initial  nropr*^  ^  inherent  limitation 

Its  program  memory,  which  is  the  location  allowed  to  alter  anv  of 

-yonlychangeits'datameltraTah^^^^^^^ 

^en  a  command  is  received,  it  merelv  ra  u  ''^bere  data  values  are  stored, 
prcdetetmiued  subroutine.  The  specifics  offok^^  P™8f»m  lo  jump  down  to  a 

Tie  final  section  of  foe  m«saue  inclu^/rcRrh'’^'‘'“'‘' 
message  character.  The  CRC  CcvrliVai  ,r  j  ^  character  and  the  end-of- 
checking  tecimique  that  helps  to  elim'  7  “"*“‘^5’  '=l=':k)  character  is  a  simple  error 

message,  i,  calcltelfoe  value  ofirCRCr^''''  ^ 

message.  It  then  sends  this  CRC  charaaer  alnn"^^*^'^  h  characters  in  foe 

this  message,  it  petfotms  its  own  calcuir.L  .  a  “  ““t*'  tcceives 

sttd  compares  this  calculated  value  to  foe  receded  c'^h  ' 
same,  u  accepts  foe  messaae  as  valid  If  no. Td  If  foe  two  are  foe 

terminates  it.  Finallv  foe  end  of  m«c  1’  *““tds  foe  message  as  noise  and 

message.  It  is  a  special  character  kno™  fo  ^fol"  “df/  ^  “  “T 

message  charaaer  is  to  let  foe  receivina  ooa  r7  ““dcs.  The  pmpose  of  foe  end-of- 
coming.  Tiis  allows  it  to  begin  procesSug  foe  mrsaae'  '' 

not  have  data’' to  scnd™Tle'wa7^ns 

y  mts  IS  accomphshed  ts  by  usmg  a  token.  The  token  is 
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simply  a  special  character  that  each  node  recognizes  upon  receipt.  When  it  receK'es  tlie 
token,  it  checks  to  see  whether  it  has  data  waiting  to  be  sent,  and  either  sends  that  data  or 
another  token.  The  token  message  consists  of  only  one  character  (OOOOOOOO2)  and  an 
end-of  message  character.  It  contains  no  addressing  characters  because  a  token  may  be 
sent  to  any  node  from  the  preceding  node.  Because  of  the  umque  way  in  which  CRC  is 
calculated,  the  token  does  not  need  a  CRC  character  either. 

In  Figure  4.3,  a  sample  message  is  shown  as  it  would  be  received  by  a  node. 
FolloVking  is  a  description  of  how  the  receiving  node  interprets  the  message  and  carries 
out  its  instructions. 


0000  0010  1) 

0000  0001  2) 

0000  0011  3) 

1001  0101  4) 

01100001  5) 

1010  0001  6) 

10110101  7) 

0111  1110  8) 


TO  Address 

FROM  Address 

Command  Number 

Data 

Data 

Data 

CRC 

End-of-message 


Figure  4.3.  A  Sample  Message 


The  first  operation  that  a  node  performs  when  it  receives  a  message  is  to  determine 
if  the  message  is.  in  fact,  legitimate.  As  was  mentioned  before,  this  is  accomphshed 
through  the  use  of  the  CRC  character  at  the  end  of  the  message.  The  CRC  protocol  used 
in  the  network  is  such  that  all  of  the  characters  received  not  including  the  end-of-message 
character  are  added.  If  the  result  is  zero,  the  CRC  is  valid;  if  not,  it  fails.  The  receiving 
node,  then,  is  not  merely  looking  at  the  CRC  character.  It  never  distinguishes  this 
particular  character  from  any  of  the  others.  Rather,  it  adds  up  all  the  characters  (excluding 
the  end-of-message  character)  and  checks  for  a  result  of  zero.  The  CRC  character  is 
merely  there  to  assure  that  the  addition  equals  zero.  For  example,  looking  at  the  sample 
message,  a  receiving  node  would  begin  adding  the  bytes  in  a  binary  sense  and  throwing 
out  any  carry  bit  that  may  occur  as  a  result  of  an  addition  overflow.  (In  decimal  terms, 
this  can  be  thought  of  as  adding  a  group  of  numbers  together  one  at  a  time  and  subtracting 
256  whenever  the  sum  reaches  or  exceeds  256,  i.e.,  modulo  256  arithmetic.)  The  addition 
of  these  particular  bytes  would  go  as  follows;  Each  byte  has  the  following  decimal  value, 
respectively:  2,  1,  3,  149,  97,  161,  99,  126.  The  end-of  message  character,  which  is  not 
used  in  the  CRC  calculation,  has  the  value  126.  A  sum  of  the  first  six  bytes  would  yield 
2+14-3+149+97+161  =413.  Since  this  is  greater  than  or  equal  to  256,  256  must  be 
subtracted  from  the  sum  to  give  1 57.  When  the  next  byte  (the  CRC  byte)  is  added  to  the 
running  sum.  the  following  result  is  obtained:  157+99  =  256.  Again,  since  this  is  greater 
than  or  equal  to  256,  we  must  subtract  256  again  to  give  the  number  zero.  Since  the  next 
character  is  the  recognizable  end-of-message  character,  it  is  not  added  in  the  calculations. 
The  receiving  node  then  stops  looking  at  the  characters  and  checks  the  CRC  sum.  Finding 
that  it  is  indeed  zero,  the  node  accepts  the  message  as  valid  and  begins  processing  it. 
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The  node  then  looks  at  the  first  byte  of  the  message  and  compares  this  number  to 
its  own  address  which  is  stored  in  its  data  memory.  Assuming  they  are  the  same,  the 
processing  continues.  If  they  differ,  the  receiving  node  retransmits  to  the  next  node  in  the 
sequence  the  exact  message  it  received.  (There  is  an  option  at  starmp  to  initialize  all 
addresses  of  all  nodes  to  zero.  In  this  case,  when  node  receives  its  first  message,  it  will 
set  its  address  to  the  value  of  the  first  byte  of  the  first  message  it  receives.  It  can  then 
send  a  message  initializing  the  next  node  in  the  chain.)  If  the  addresses  are  the  same, 
which  we  will  assume  for  our  example,  the  node  proceeds  to  the  next  byte  of  the  address, 
where  it  stores  the  address  of  the  sender.  At  present,  this  feamre  is  not  used  to  its 
maximum  potential.  While  a  node  still  records  the  sender,  it  never  acmally  uses  this 
mformation.  Leaving  this  as  part  of  the  general  protocol,  however,  allows  for  easy  future 
improvements  and  customized  messages. 

With  addressing  complete,  the  receiving  node  looks  at  the  third  byte  of  the 
message  the  command  byte.  It  stores  this  command  number  in  a  data  reaster  and 
performs  a  jump  to  the  appropriate  subroutine.  Appendix  A4  gives  the  deta'ils  of  this 
operation. 

When  the  processor  jumps  to  the  appropriate  subroutine,  it  mav  require  some  data 
(supplied  in  the  message  string)  to  complete  its  task.  This  data  is  taken  from  the 
remaining  bytes  in  the  message.  In  the  example,  it  can  be  seen  that  Command  3  required  3 
bvles  of  data.  This  data  is  taken  from  bytes  4,  5,  and  6  of  the  message.  As  mentioned,  the 
sending  node  knows  what  command  it  is  telling  the  receiving  to  node  to  execute  and 
therefore  knows  which  data  to  send  in  the  remaining  bytes  of  the  message. 

At  this  point  the  receiving  node  is  finished  executing  its  command.  This  command 
may  or  may  not  have  required  it  to  send  a  certam  message  to  another  node  or  even  to  the 
same  node  that  sent  it.  In  this  case,  it  sends  this  message  right  away  in  the  same  format  as 
discussed  earlier.  In  most  cases,  however,  a  command  wiU  not  require  that  the  node  send 
data  across  the  network.  In  these  simations.  after  a  node  has  executed  the  command  it 
was  mstructed  to  execute,  it  checks  a  flag  to  see  whether  input  from  the  user  or  attached 
sensors  requires  it  to  send  a  message.  This  may  occur  when  the  camera  detects  a  change  in 
the  position  of  the  baU  or  when  the  user  turns  the  shaft  encoder,  indicating  a  change  in  the 
desired  p  osition  of  the  ball.  If  it  has  data  to  send,  it  jumps  to  the  subroutine  which  loads 
the  data  into  the  appropriate  message  registers  and  then  goes  to  its  Transmit  subroutine, 
which  sends  data  from  the  message  registers  until  the  end-of  message  character  is  reached. 
If  the  computer,  after  having  received  a  message  addressed  to  it  or  a  token,  discovers  that 
it  does  not  have  data  to  send,  it  simply  sends  a  token  to  keep  communications  going. 

This  seemingly  simple  format  still  has  various  weaknesses  that  must  be  overcome. 
For  example,  if  one  node,  because  of  sensor  input,  grabs  the  token  every  time  that  it  sees 
it  and  sends  a  message  for  another  token  down  the  line,  no  processors  between  this  node 
and  the  node  to  which  it  sends  information  will  ever  have  the  chance  to  transmit  a 
message.  Because  this  problem  is  more  application  specific,  it  must  be  dealt  with 
depending  on  the  application.  In  the  application  presented,  the  node  communicating  with 
the  camera  is  the  only  node  whose  sensor  input  might  direct  it  to  send  information  nearly 
every  time  it  encounters  a  token.  The  problem  is  solved  in  this  case  by  placing  the  node 
that  receives  these  messages  immediately  following  the  node  sending  them  in  the  ring 
sequence.  Another  solution  might  have  been  to  have  the  camera  node  send  a  message 
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only  eveiy'  five  times  it  sees  a  token,  for  example.  This  would  allow  the  other  nodes  ample 
time  to  send  their  traflac. 

This  problem  seems  small,  but  it  could  actually  effectively  lock  out  all  other  nodes 
fi'om  commumcating  across  the  network.  One  of  the  main  reasons  for  choosing  a  token 
ring  network  in  the  first  place  was  its  almost  perfect  ability  to  guarantee  every  node  a 
chance  to  send  a  message  when  it  needed  to.  The  removal  of  this  benefit  by  poor 
placement  of  two  nodes  in  the  network  who  need  to  engage  in  a  great  deal  of  one-way 
communication  could  be  disastrous. 

A  diagram  of  the  network  as  it  is  implemented  is  shown  in  Figure  4.4.  As  can  be 
seen,  the  network  contains  a  double  loop,  with  one  particular  node  being  assigned  to  both 
loops.  The  reason  for  this  is  to  accommodate  a  personal  computer  into  the  network  yet 
still  allow  each  the  PIC  processors  to  communicate  if  the  PC  were  removed.  The  exira 
work  required  by  the  node  attached  to  both  of  the  loops  will  be  explained  in  detail  later. 
The  important  point  to  note  is  that  only  one  token  is  actually  being  passed  around  betw'een 
both  loops.  The  node  wliich  acts  as  a  conduit  between  the  loops  is  able  to  detect  which 
node  it  recewes  its  last  message  fi'om  and  send  the  next  message  to  the  other  node.  A  less 
physically  accurate,  but  more  theoretically  correct  model  of  the  network  is  shoun  in 
Figure  4.5.  Flere.  the  network  is  modeled  as  a  single  loop  with  one  node  appearing  two 
times  in  the  loop.  This  represents  how  the  actual  information  passes  when  the  PC  is 
present  in  the  loop. 


Figure  4.4.  Network  Connection  Scheme 


Figure  4.5.  Nenvork  Token  Passing  Model 


It  IS  convenient  to  number  the  nodes  in  order  to  more  clearly  describe  the  specific 
aipnthm  that  each  foUows  while  the  network  is  running.  The  most  intuitive  system  of 
labeling  is  simply  to  label  the  processors  with  the  actual  address  that  they  possess  upon 
startup.  :niis  addressing  system  is  shown  below  in  Table  4.1.  Each  node  of  the  network  is 

preset  to  follow  a  specific  algorithm  to  handle  message  passing.  That  algorithm  will  be 
explained  here  briefly  to  show  the  broad  picture  of  the  token  i^g  and  then  explained  in 
detail  m  the  foUowmg  chapters.  Node  1,  the  PC,  starts  the  sequence  with  a  keystroke 
om  the  user.  This  irntiams  a  token  pass  to  node  2,  which  then  checks  to  see  if  it  has  any 
ormation  to  send,  specifically,  a  new  desired  position  that  the  user  may  have  updated 
using  the  shaft  encoder  attached  to  the  LCD  display.  If  the  position  did  change,  which 
occurs  relatively  infi-equently  given  the  speed  at  which  messages  pass  around 'the  network, 
node  2  generates  a  message  to  node  I,  informing  it  of  the  desired  change  of  position.  This 
message  will  be  passed  through  nodes  3  and  4  and  back  to  node  2,  the  sender  of  the 
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message.  Node  2  will  recognize  that  the  message  was  relayed  from  node  4,  and  therefore 
transmit  it  to  node  1,  the  PC.  The  PC  will  then  update  the  change  in  desired  position  on 
the  screen  and  send  a  message  to  node  2  telling  it  that  it  may  now  change  the  desired 
position.  Now  node  2  sends  a  message  to  node  4,  telling  the  motor-controlling  PIC  the 
new  desired  position  of  the  ball.  No  response  to  this  message  is  needed.  If  the  desired 
position  had  been  changed  at  the  computer  display,  node  1  would  have  informed  node  2  to 
change  its  desired  position  and  it  would  have  relayed  this  information  on  to  node  4. 


Node 

Processor 

Function 

1 

PC 

Display  state  variables,  allow  changing  of  desired  position. 

2 

PIC 

Handle  communications  with  PC,  Display  position  and  desired 
position  on  LCD  display. 

a 

PIC 

Monitor  camera  inputs  and  send  them  to  motor-controlling 

PIC. 

4 

PIC 

Control  motor,  using  digital  state  feedback. 

Table  4.1.  Nodes  and  their  Functions 


This  seems  rather  comphcated,  but  the  entire  process  requires  at  most  rv\^o  loops  in 
the  ring,  and  this  is  only  if  the  desired  position  changes.  If  the  user  makes  no  chanaes  at 
the  PC  or  LCD  console,  then  these  two  nodes  pass  tokens  to  node  3,  where  a  check  is 
made  to  see  if  the  camera  detected  a  position  or  velocity  change  of  the  ball.  If  either  of 
these  variables  have  changed,  then  node  3  sends  the  new  values  to  node  4,  where  the 
control  routine  uses  this  mfonnation.  Once  node  4  has  received  the  token  (or  a  messaae 
addressed  to  it),  it  decrements  a  counter.  When  this  counter  reaches  zero,  it  transmits  all 
of  its  state  information  to  node  1,  the  PC,  for  display.  The  counter  can  be  set  to  any 
number,  depending  on  how  frequently  the  display  needs  to  be  updated,  but  the  process  is 
so  fast  compared  to  what  the  eye  can  see  that  it  does  not  have  to  pass  it  very  often.  This 
also  cuts  down  on  message  traflBc  which  may  have  precluded  another  node  from  sending 
data. 


5.  Individual  Nodes 
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5. 1  Node  2;  Interfacing 

as  a  median:  chrough  wUch  infLTn  ptes  be^ZThe  pC  ^ 

oeuvork.  I.  also  prints  position  and  desnld  posta  iSol^n”  ^VcD  d^ll^ 
acceptma  user  inouts  from  a  cliaft  o°  an  LCD  display  while 

drop  low.  If  the  stan  bit  has  in  fact  7T  ^ 

of  the  first  incoming  bit  and  reads  its  valur'^lT^  •  ^  midpoint 

bit  until  it  reaches  the  ston  hit  H  ■  contmues  delaying  to  the  midpoint  of  everv 

register.  I.  Tea  see  if  el,''”"'  =  ' 

begins  processing  thf™.  I^lof  ftT"  "  charaaer.  If  it  is.  i, 

another  stan  bit  causes  it  toT  r  '  •  mues  executmg  its  main  program  until 

sampled  by  the  node  at  the  midpZX^ry  r''  '' ' 


sampling  function 


Figure  5. 1.  Sampling  of  an  Incoming  Transmission 


besides  the  communications  between  the  PC  ^  performs 

-rorrealtimedataasmt^rr-^^^^^^^^ 
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seriously  if  the  display  is  not  updated  10  ms  from  receKhig  the  command.  Other  nodes 
might  react  unpredictably  if  one  of  these  messages  interrupted  its  critical  timing  loops.  If  a 
PIC  without  serial  communication  were  used  for  one  of  these  nodes,  a  new  time-interrupt 
driven  routine  would  need  to  be  used,  where  the  processor  is  able  to  return  to  the  main 
part  of  Its  program  and  come  back  to  check  the  data  bits  at  their  midpoints.  This  would 
not  be  too  difiScult  a  problem. 


The  processor  at  node  2  must  also  distinguish  between  commumcations  coming 
from  the  PC  and  those  coming  from  other  nodes  in  the  network.  With  only  one  interrupt 
pin,  this  task  requires  either  that  polling  be  used  or  that  the  receive  signals  from  the  two 
different  sources  actuaUy  come  in  on  the  same  pin.  This  second  method  is  possible  using 
an  OR  gate  to  allow  whichever  of  the  two  signals  comes  in  to  pass  and  two  distinct 
transmit  pins  —  one  for  each  of  the  two  connecting  nodes.  A  diagram  of  this  is  shown  in 
Figure  5.2  Since  both  sources  cannot  transfer  at  the  same  time,  the  data  out  of  the  OR 
gate  will  always  be  vahd  transmission  data.  The  problem  is  detecting  which  of  the  nodes 
actually  transmined.  If  one  of  these  two  nodes  generated  a  message  then  the  sender  can 
be  discovered  merely  by  reading  the  from  address  attached  to  all  messages.  If  however, 
the  more  hkely  situation  arises  where  one  of  the  two  nodes  is  either  passing  along  a  token 

or  a  message  transmined  by  a  different  node,  there  is  no  way  to  tell  where  the  message 
came  from.  " 


Figure  5.2.  Receive  Input  Logic  of  Node  2 


The  solution  to  this  problem  is  adding  a  two  byte  prefix  onto  all  messages  from  the 
PC.  This  will  allow  node  2  to  immediately  identify  wWch  node  sent  it  the  message.  It  can 
then  retransmit  the  message  to  the  node  that  did  not  send  it.  The  token  character,  instead 
of  simply  a  zero  followed  by  an  end  of  message  character  becomes  the  two  prefix  bytes, 
followed  by  the  zero,  then  a  CRC,  and  finally  an  end-of-message  character.  The  CRC 
byte  is  now  needed  because,  presumably,  the  prefix  characters'are  not  both  equal  to  zero, 
so  they  will  skew'  the  CRC  check  without  a  CRC  character  to  force  it  to  zero. 


5.2  Node  3;  Image  Processing 

An  integral  part  to  the  control  aspect  of  this  project  is  the  method  of  measuring  the 
values  of  the  states  so  that  they  can  be  used  in  a  control  algorithm.  The  measurement  of 
the  linear  position  and  velocity  of  the  ball  is  performed  by  a  sensor  suite  consisting  of  a 
CCD  analog  camera,  an  LM1881  sync  separator,  and  an  LM339N  quad  comparator. 

Each  of  these  components  allows  for  the  proper  communication  of  useful  digital  data 
between  the  camera  and  the  sensors. 
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The  camera  has  only  three  required  connections;  +12  V  DC,  ground  ,  and  the 
video  output  signal.  This  output  signal  is  analog  m  nature  and  can  be  viewed  on  a 
monitor.  The  camera  sends  out  visual  data  in  an  interlaced  format;  it  sends  all  of  the  odd 
lines  followed  by  all  of  the  even  lines.  The  camera  is  able  to  transmit  these  signals  at  such 
high  speeds  that  it  appears  that  the  picture  is  being  refreshed  aU  at  once.  Between  each 
line,  the  camera  sends  a  horizontal  sync  pulse  to  indicate  another  line  is  comina.  This  can 
be  seen  in  Figure  5.3,  where  a  typical  line  of  data  is  shown.  The  sync  pulse  la^s  for 
approximately  5  microseconds.  During  this  time  a  blanking  voltage  of  0  V  is  sent  to  the 
momtor.  After  the  sync  pulse,  there'is  approximately  5  more  microseconds  of  useless  data 
before  the  actual  line  data  is  transmined.  Each  line  of  data  lasts  approximately  63.5 
microseconds. 

Sunilarly,  after  each  half  screenful  (262.5  lines)  is  transmitted,  the  camera  sends  a 
vertical  s\tic  pulse  to  indicate  that  another  page  is  coming.  Shown  m  Fiaure  5.4,  this 
pulse,  which  occurs  much  more  infrequently  ^an  the  horizontal  svnc.  lasts  for  a  much 
longer  duration  (approximately  240  microseconds).  The  time  between  vertical  svnc  pulses 
IS  approximately  16.67  milliseconds,  the  time  required  for  262.5  horizontal  sync  pulses 

and  lines  of  data  to  go  by.  Again,  there  are  useless  data  transmined  before  the  first  visual 
line. 


5  us 


S3. 5  us 


Figure  5.3.  Analog  Line  Data 


vertical  sync 


Figure  5.4.  A  Vertical  Sync  Pulse 

Unfortunately,  data  sent  in  this  way  are  not  \'er>^  helpfiil  to  the  user  of  a  digital 
computer.  The  solution  to  this  problem  is  the  LM1881  sync  separator.  This  8-pin  chip 
takes  as  its  input  the  analog  output  of  the  camera.  It  anah'zes  the  camera  signal  and 
‘‘strips”  several  useful  signals  from  it.  The  vertical  and  horizontal  sync  pulses  without  the 
corresponding  line  data  are  outputs  of  this  chip,  as  is  a  signal  which  changes  sign  each 
time  the  camera  switches  between  transmitting  even  lines  and  transmitting  odd  lines.  Each 
of  these  signals  is  extremely  useful  to  the  microprocessor  because  it  is  purely  digital:  the 
only  allowable  output  voltages  are  0  V  and  5 V,  One  can,  for  instance,  detect  what  row  to 
monitor  by  w'atching  the  vertical  sjiic  pin  until  the  pulse  is  recewed  and  then  counting  the 
horizontal  sync  pulses  until  the  desired  row  is  reached. 

Now  that  the  various  sync  pulses  have  been  removed  so  that  they  may  be  used 
eflSciently  by  the  microprocessor,  the  analog  data  must  be  manipulated  in  a  similar  manner. 
For  this  particular  application,  the  camera  is  searching  for  a  white  marble  on  a  dark  eray 
background.  Assuming  the  computer  can  find  the  right  line  of  data  to  read,  its  data  will 
look  something  like  Figure  5.5.  The  entire  line  will  be  dark  except  at  the  coordinates 
where  the  ball  is  located.  What  is  needed  is  a  way  to  teU  the  computer  digitally  when  the 
ball  is  found.  TTie  solution  to  this  part  of  the  problem  is  a  simple  comparator  wfrose  two 
inputs  are  the  analog  output  of  the  camera  and  a  constant  threshold  voltage  which  is 
supplied  by  a  voltage  divider.  The  output  of  the  comparator  will  simply  be  0  V  for  every 
instance  in  time  where  the  camera’s  output  is  less  than  the  threshold  voltage.  When  the 
camera  s  output  voltage  exceeds  the  threshold  voltage  (i.e.,  when  the  ball  is  sighted),  a 
signal  of  5  V  will  come  from  the  comparator.  The  microprocessor  can  monitor  this 
change  and  therefore  be  able  to  locate  the  ball. 
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Figure  5.5.  Camera  Output  When  Ball  is  Found 


With  all  the  signals  now  conditioned  to  act  as  inputs  to  the  PIC16C74 
microprocessor,  what  still  remains  is  to  actually  unplement  an  algorithm  to  continuously 
monitor  the  position  and  velocity  of  the  ball.  The  algorithm  is  interrupt-driven  for  precise 
timmg  and  quick  response.  There  are  myriad  interrupts  on  the  PIC  16C74.  These  include 
a  pin  that  will  interrupt  on  low-to-high  or  high-to-low  transition,  several  pins  which  will 
interrupt  when  they  change  value,  a  timer  that  will  interrupt  when  it  overflows,  and 
numerous  others.  Because  of  the  many  inputs  to  the  processor,  it  would  be  dfficult  and 
time  consuming  to  simply  poll  each  input  until  one  of  them  changes.  Furthermore,  a 
possibility  exists  that  important  data  could  be  missed  if  the  microprocessor  was  pollins 
another  input  when  data  changed  on  the  relevant  line.  To  prevent  this  from  happenina, 
interrupts  are  used  which  allow  the  program  to  continue  running  until  a  certain  condition 
is  detected  by  the  hardware.  This  causes  the  program  to  jump  to  a  subroutine  where 
diflTerent  actions  can  be  taken  depending  on  the  source  of  the  interrupt. 

The  PIC  microprocessor  monitoring  the  camera  node  uses  three  different 
interrupts  for  the  purpose  of  detennining  the  velocity.  The  odd/even  signal  from  the  sync 
separator  connects  to  one  of  the  input  pins  on  the  PIC  with  an  interrupt  on  change  feature. 
Every  time  this  signal  transitions  from  low  to  high  or  high  to  low,  an  interrupt  is 
generated.  This  allows  the  PIC  to  prepare  for  afl  of  the  even  or  odd  lines  to  be 
transmitted.  The  horizontal  sync  pin  from  the  sync  separator  is  connected  to  the  only  pin 
on  the  PIC  that  will  interrupt  only  on  one-sided  transitions  (low-to  high,  for  example). 

This  can  be  set  at  compile  time  to  occur  when  the  pin  transitions  from  high-to-low  or  from 
low-to-high.  but  not  both.  In  this  particular  case,  since  the  horizontal  sync  is  a  low-going 
transition,  the  interrupt  pin  is  set  to  monitor  high-to-low  transitions.  The  third  intermpt 
used  is  generated  by  the  internal  timer.  The  PIC  possesses  an  internal  timer  that 
increments  every  instruction  cycle.  By  using  an  available  prescaler,  this  timer  can  also 
increment  every  2,  4,  8,  16,  or  32  instructions.  The  timer  is  a  one-byte  register,  so  its 
maximum  value  is  255.  When  the  timer  increments  from  255,  it  overflows  to  zero,  and  the 
timer  interrupt  flag  is  set.  This  interrupt  is  extremely  useful  for  calculating  time  dependent 
quantities  such  as  velocity. 

The  basic  algorithm  for  the  node  watching  the  camera  is  outlined  in  the  following 

steps: 


1.  Wait  for  the  odd/even  pulse  —  this  tells  the  microprocessor  that  the  beginning  of 
a  screen  has  been  foimd,  giving  it  a  reference  point  for  counting  lines  as  they  are 
transmitted.  Both  odd  and  even  frames  are  equally  useful,  so  no  distinction  need  be  made. 

2.  Wait  until  desired  number  of  horizontal  sync  pulses  have  passed  —  after  the 
odd/even  pulse,  a  certain  number  of  lines  will  be  transmitted  before  the  line  on  which  the 
relevant  data  exists.  Count  and  wait  as  these  lines  pass. 

3.  Measure  the  time  until  the  ball  is  found  —  this  action  is  performed  without  the 
use  of  an  interrupt.  Once  the  correct  line  is  located,  the  output  from  the  comparator  is 
simply  polled  until  a  high  value  is  obtained  (this  is  the  value  where  the  camera's  output 
voltage  exceeds  the  threshold  voltage).  This  time  can  easily  be  converted  into  a  distance, 
with  experimentation. 

4.  Calculate  velocit\-  every  10  ms  —  here  the  timer  interrupt  is  used  to  measure  an 
exact  period  of  time  so  the  velocity  can  be  quickly  calculated.  Whatever  the  position  is 
when  this  interrupt  occurred  last  will  be  subtracted  from  the  position  at  the  current 
interrupt.  This  will  teU  how  far  the  ball  has  moved  in  10  ms,  i.e.,  we  have  calculated  the 
ball's  velocity'. 

5.  Repeat  the  process  —  wait  for  the  next  odd/even  pulse  and  begin  again. 


The  effect  of  the  node  attached  to  the  camera  in  the  overall  token  passing  process 
is  fairly  sunple.  It  must  have  the  ability'  to  pass  any  messages  it  recewes  to  the  next  node 
in  the  sequence  (as  must  all  the  nodes)  as  well  as  the  abihty  to  generate  a  message  that 
sends  the  position  and  velocity  data  of  the  ball  to  the  motor-controlling  node.  This  node 
does  not.  however,  need  to  worry  about  receiving  any  messages  since  there  are  no 
parameters  that  ever  need  changing.  The  algorithm  for  message  handling  is  simple.  If  the 
node  receives  a  message  addressed  to  a  node  other  than  itself^  it  checks  the  CRC  and  then 
passes  along  the  message  to  the  next  node  in  the  ring.  If  the  node  receives  a  token,  it 
checks  to  see  whether  the  position  and  velocity  of  the  ball  have  changed  since  the  last 
update.  If  one  or  both  of  them  have  changed,  the  node  sends  a  message  to  the  motor¬ 
controlling  node  (which  happens  to  be  the  next  in  sequence)  updating  these  two  states.  If 
the  node  happens  to  receive  a  message  addressed  to  it,  it  checks  the  CRC  but  ignores  the 
content  of  the  message  and  treats  it  like  a  token.  If  the  CRC  check  ever  comes  up  wrong, 
the  node  ignores  whatever  message  was  received  and  sends  a  token. 

Part  of  this  algorithm  works  so  well  because  the  node  watching  the  camera  output 
is  positioned  immediately  before  the  motor-controlling  node  in  the  sequence.  If  there 
were  nodes  in  between  the  two,  a  different,  more  complicated  algorithm  would  need  to  be 
written  so  that  the  node  assigned  to  the  camera  does  not  take  control  of  the  token  every 
time  it  receives  it.  This  is  acceptable  presently  because  its  message  is  always  for  the  node 
immediately  following  it.  However,  if  nodes  between  these  two  wanted  to  send  a 
message,  they  would  never  have  the  chance  except  in  the  rare  case  where  position  and 
velocity  data  did  not  change  between  passes.  This  placement  is  not  an  accident,  nor  is  it 
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simply  a  convenient  way  to  avoid  a  problem  In  a  token  ring  network,  it  makes  a  itood 
deal  of  sense  regardless  of  physical  location  to  place  a  node  that  sends  messages  " 
exclusively  to  one  other  node  immediately  preceding  this  other  node.  This  is  especially 

true  if  the  sending  node  must  send  this  data  frequently,  as  is  the  case  with  the  camera-' 
watching  node. 


5.3  Node  4;  Motor  Control 

The  node  which  is  most  directly  responsible  for  the  implementation  of  the  motor 
control  IS  the  PIC16C74  processor  at  node  4.  This  processor  is  responsible  for  acceptina 
desired  position  inputs  from  nodes  1  and  2  and  actual  position  and  velocity  inputs  from 
node  j.  At  the  same  time,  this  processor  must  monitor  the  turn  of  the  motor  to  measure 
me  two  other  states— angular  position  and  velocity  of  the  beam.  This  requires  a  sreat 
ea  0  the  processor  s  resources  and  therefore  is  best  suited  to  the  PIC  1 6C74. 

I^e  processor  measures  the  angular  position  and  velocity  of  the  motor  by  usina  an 

optical  shaft  encoder  which  is  anached  to  the  motor  itself  TTiis  shaft  encoder  has  two” 

important  outputs  wiiich  are  denoted  Phase  A  and  Phase  B.  These  are  the  outputs  that 

c  ange  as  the  motor  is  turned.  A  representation  of  the  two  outputs  is  shown  below  in 
nanre  5.6. 


Figure  5.6.  Phase  Outputs  of  Shaft  Encoder 


The  way  these  outputs  work  is  fairly  simple.  As  the  motor  turns  in  a  clockwise 

ection.  e  two  signals  proceed  from  left  to  right  in  the  figure  above.  If  the  motor 
instea  moves  counterclock-wise,  the  signals  move  from  right  to  left.  The  signals  change 
at  a  ^eed  proportional  to  the  motor  speed,  with  a  resolution  of 4000  phase'transitions'per 
revolution.  By  momtoring  the  changing  of  these  signals,  one  can  easily  determine  how  far 
and  in  what  direction  the  motor  has  moved. 

program  performs  this  is  by  accepting  Phase  A  as  the  input 
to  a  pin  which  mtemipts  on  a  low  to  high  transition  and  Phase  B  on  a  noninterruptable 
pm.  Whoever  Phase  A  goes  high,  the  program  checks  Phase  B  to  see  whether  it  is  high 
or  ow.  This  detenmnes  motor  direction.  For  example.  Figures  5.7  (a)  and  (b)  show  tL 
erence  of  the  two  signals  in  a  clockwise  and  counterclockwise  motion.  These  signals 


at  first  look  the  same,  but  upon  closer  inspection,  are  very  different.  Each  time  Phase  A  is 
transitioning  fi-om  low  to  high  in  figure  5.7  (a).  Phase  B  is  at  a  low  point.  On  the  other 
hand,  each  time  Phase  A  goes  fi'om  low  to  high  in  the  counterclockwise  direction,  in 
Figure  5.7  (b).  Phase  B  is  high.  So  the  processor  knows  after  checking  Phase  B  that  the 
motor  moved  one  count  in  either  a  clockwise  or  counterclockwise  direction.  It  can  store 
this  in  a  register  and  update  it  each  time  an  interrupt  is  detected. 

It  may  be  noted  that  this  method  of  measuring  the  angular  position  reduces  the 
precision  by  one  fourth.  Instead  of  updating  the  angular  position  register  each  time  either 
phase  changes  value,  it  is  updated  only  when  phase  A  goes  high.  This  reduces  the 
resolution  to  1000  counts  per  revolution.  It  is  advantageous  to  give  up  this  resolution 
because  it  is  not  reaUy  needed.  At  1000  counts  per  revolution,  the  register  storing  the 
angular  position  increments  nearly  3  times  for  every'  degree  turned,  easily  precise  enough 
for  the  current  problem.  If  the  processor  were  to  interrupt  four  times  as  often,  problems 
with  timing  and  switching  between  functions  would  arise  much  more  fi'equently.  There 
would  be  httle  time  to  spend  in  the  main  program  and  excessive  amounts  spent  in  the 
interrupt  routine. 


(a)  Clockwise  Motion 


A 


(b)  Counterclockwise  Motion 


Figure  5.7.  Phase  Outputs  of  Shaft  Encoder 


Once  the  motor-controlling  node  has  calculated  the  angular  position  and  velocity 
of  the  track  using  the  shaft  encoder,  and  has  received  fi'om  the  camera  node  the  position 
and  velocity  of  the  ball,  h  is  ready  to  begin  implementing  the  state  feedback  control  that 
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was  discussed  earlier.  Because  of  the  digital  nature  of  the  microprocessor,  the  feedback  is 
sampled  at  a  regular  time  interval.  This  data  is  used  to  calculate  the  torque  that  the  motor 
must  exen  m  order  to  drive  the  baU  toward  its  desired  position.  The  sampling  time  chosen 
for  this  particular  problem  was  10  milliseconds.  This  allows  ample  time  for  the  many 
midtiphcations  required  to  obtain  the  solution.  Because  the  processor  has  no  built  in 
m  tiphcation  routine,  repeated  additions  are  required  to  multiply  two  numbers  together 
1  his  requires  time  as  one  register  is  shifted  while  the  other  is  added  repeatedly. 

As  mentioned  before,  the  proposed  design  is  an  integral  state  feedback  design, 
his  requires  the  processor  to  perform  some  operation  comparable  to  an  integral  of  the 
error  data  it  receives.  The  way  the  processor  accomplishes  this  is  by  performing  a  digital 
hrst  order  Euler  approximation  to  the  integration.  A  first  order  Euler  approximationls 
given  m  (5. 1)  with  the  equivalent  integral  form  shown  in  (5.2). 


x(f+At)  =  x(t)  +  x{t)At  (5.1) 

j  x(t  +  At)clt  =  j  x{t)dl +x{t)A[  (5.2) 


The  way  that  the  processor  calculates  the  btegral  is  by  assuming  a  step  sbe  of  1 00 
miJhseconds  and  calculating  the  diflJerence  between  the  desired  position''and  actual 
position  at  each  san^le.  This  difierence  is  then  multiplied  by  the  step  size  A/ and  added  to 

to  r  f  C““se  the  integral 

to  mcrease  mdefimtely  if  the  baU  were  not  responding  properly.  For  this  reason,  a  Umir  is 

^aced  on  the  maximum  value  of  the  integral.  When  this  limit  is  reached,  ma.ximum  torque 
wiU  be  applied  to  the  motor.  ^ 

thic  r  calculates  the  required  torque  needed  bv  the  motor,  it  applies 

torque  by  making  use  of  the  UDN-2954  motor  driver.  This  chip,  essentiallv  an  H- 
bndae  with  four  transistors,  allows  the  PIC  to  use  pulse  width  modulation  (PWM)  to  drive 

r  f "  directions.  Fortunatelv.  this  is 

t^  fir  “  '^P  registers  related 

°r  in  a  single 

ruction  cycle.  The  way  PWM  works  is  simple.  The  periodic  PWM  output  drives  the 
base  of  a  transistor  which  allows  current  from  the  power  source  to  flow  through  the  motor 
m^e  same  penodic  signal.  When  this  square  wave  is  input  into  the  motor,  it  possesses  a 
DC  average  value  as  weU  as  components  at  multiples  of  its  frequency.  A  DC  motor  being 
w  pass  filter,  these  high  frequency  terms  are  cut  oflf.  So,  in  effect,  a  +6  V  DC  value  " 
can  be  created  by  driving  a  +12  V  square  wave  at  50%  duty  cycle. 

wfiinfi  ^at  the  motor  driver  requires  is  a  Phase  input.  This  is  the  input 

hich  teUs  the  driver  which  way  the  motor  is  to  be  turned.  By  using  these  two  inputs 
alone,  the  processor  is  able  to  turn  the  motor  at  any  speed  up  to  its  maximum  in  either 
toectiom  When  the  program  calculates  the  required  value  for  the  torque,  it  checks  to  see 
whet^r  the  number  is  positive  or  negative.  This  determines  whether  the  Phase  gets  set  or 
not.  1  he  program  then  calculates  the  magnitude  of  the  required  torque  and  places  a 
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multiple  of  this  value  in  the  PWM  register.  In  this  way,  the  PIC  is  able  to  successfully 
implement  state  feedback  control.  A  Phase  and  Enable  combination  is  shown  below  in 
figme  5.8.  The  Enable  pin  is  active  low,  so  the  extremely  short  duty  cycle  shown  in  the 
figure  will  actuaUy  cause  the  motor  to  turn  at  a  high  speed. 


+5  V 


GND 


Phase 


GND 


Enable 

Figure  5.8.  Motor  Driving  Signals 


Most  of  the  communications  performed  by  node  4  are  receptions.  The  only 
message  that  this  node  transmits  is  a  periodic  update  of  its  state  data  every  five  passes 
throught  the  control  loop,  at  wiiich  pomt  h  sends  to  the  PC  the  present  values  of  position 
and  velocity  of  the  baU,  and  angular  position  and  angular  velocity  of  the  track. 

One  of  the  abilhies  that  was  considered  when  designing  the  network  was  that 
certain  values  might  need  to  be  obtained  at  startup  that  were  not  initially  hardcoded  into 
the  programming  of  the  actual  processors.  It  is  for  this  reason  that  a  serial  EEPROM 
(electrically  erasable  programmable  read  only  memory)  is  attached  to  four  pins  of  the  node 
govenung  motor  control.  This  EEPROM  can  store  up  to  256  16-bit  values  in  its  memory, 
and  h  will  retain  these  values  when  power  is  lost  to  the  network.  This  is  a  useful  place  to 
store  feedback  gains  for  the  processor  to  use  wdien  controlling  the  motor.  It  may  also  be 
useful  for  storing  values  of  trigonometric  functions  that  play  a  part  in  nonlinear  problems 
like  this  one.  The  EEPROM  can  be  read  in  a  single  interaction  cycle.  This  allows  the 
programmer  to  place  useful  data  in  the  EEPROM  ahead  of  time  without  worryuig  about 
long  delays. 

A  series  of  subroutines  coded  into  the  processor  at  node  3  controls  their  operation. 
The  connection  requires  only  four  wires;  a  clock  pin,  chip  select,  data  mput,  and  data 
output  line.  The  process  for  reading  fi'om  or  writmg  to  the  EEPROM  requires  first  that 
the  chip  select  be  tiuned  low  and  that  the  proper  command  is  clocked  in  serially  across  the 
data  input  line.  The  EEPROM  interprets  the  command  and  either  waits  for  more  data 
over  the  same  line  in  the  case  of  a  write  command  or  places  data  on  the  data  output  line  if 
a  read  command  is  invoked. 
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The  use  of  the  EEPROM  in  the  control  problem  adds  a  sense  of  robustness.  A 
user  desiring  to  change  the  feedback  gains  can  simply  program  the  EEPROM  at  his  leisure 
and  replace  the  existing  EEPROM  in  order  to  alter  the  response  of  the  ball.  This  may  be 
especially  useful  in  a  situation  where  no  PC  is  present  in  the  loop. 
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6.  Conclusions 

The  research  performed  thus  far  has  proven  the  token  ring  as  a  legitimate  choice  of 
a  protocol  for  a  control  network.  A  network  has  been  created  and  messages  relating  to 
the  control  problem  are  able  to  pass  through  it  without  flaw.  The  entire  control  problem 
has  not  yet  been  completed  as  there  are  still  problems  with  the  digital  state  feedback 
routine.  Still,  enough  is  working  to  make  several  conclusions  about  the  performance  of 
the  token  ring  protocol  for  real-time  control  networks. 

The  response  time  noticed  as  messages  are  being  passed  among  the  nodes  is  fast 
enough  for  the  sample  control  application.  One  of  the  worries  when  choosing  a  token  ring 
network  is  that  as  the  number  of  nodes  is  increased,  the  time  for  a  message  to  pass  around 
the  loop  increases  as  well.  In  the  specific  apphcation,  the  messages  clearly  pass  fast 
enough  to  allow  the  motor-controlling  node  enough  time  to  perform  its  intense 
mathematical  subroutines  on  updated  information,  instead  of  havong  to  use  the  same 
sample  on  several  times. 

Even  more  importantly,  each  message  was  able  to  send  its  data  packet  in  less  than 
two  passes  of  the  token  around  the  entire  loop.  The  most  important  advantage  of  using  a 
token  ring  network  is  that  all  messages  that  need  to  send  data  will  be  able  to  send  that  data 
in  under  a  specified  period  of  time.  Under  many  of  the  other  possible  protocols,  the 
average  message  time  was  much  quicker,  but  this  gain  in  speed  was  at  the  cost  of 
determinacv  —  one  could  never  know  exactly  when  a  node  would  communicate  its  data. 

If  two  nodes  attempted  to  communicate  at  the  same  time,  they  could  temporarily  stall  the 
network.  This  is  not  a  problem  in  the  token  ring  network. 

The  cychcal  redundancy  checking  proved  an  effective  way  of  stopping  errors  in  the 
network.  When  a  faulty  message  was  intentionally  sent,  the  first  node  that  receK  ed  it 
absorbed  the  faulty  message  and  sent  a  token  instead.  The  error  detection  rate 
approached  100  %  using  random  flawed  data.  The  only  situations  in  which  the  CRC 
check  failed  is  when  the  same  bit  in  an  even  number  of  characters  was  altered,  but  this  was 
ex^pected  and  accepted  as  a  limitation  of  the  CRC  error-checking  protocol.  Very  httle 
time  passes  while  a  node  calculates  the  CRC  h  is  required  to  send  along  with  its  message. 
The  benefit  of  using  more  advanced  error- checking  routines  that  find  nearly  all  errors  is 
offset  by  the  loss  of  network  speed. 

This  network  of  single-chip  microcomputers  was  able  to  successfully  communicate 
with  a  modem  personal  computer.  This  allows  a  user  to  update  data  directly  using  a 
medium  with  which  he  is  famihar.  Further,  myriad  apphcations  are  possible  now  that  this 
network  can  interact  with  a  PC  using  the  RS-232  standard. 

The  token  ring  protocol  used  in  control  networks  of  tiny  microcomputers  has 
proven  very  effective  in  the  sanqile  control  application.  In  spite  of  its  failure  to  complete 
the  problem  in  its  entirety,  the  scheme  of  message  passing  and  error  checking  performed 
flawlessly  and  efficiently.  Several  apphcations  now  exist  in  which  the  use  of  this  protocol 
may  prove  beneficial,  and  the  future  will  continue  to  see  the  rise  of  such  apphcations.  One 
vision  of  the  future  is  shared  below: 

“Picture  your  office  building  early  one  morning,  some  years  hence.  You  get  in  by 
shding  your  badge  through  an  access  system’s  card  reader.  Instantly,  the  hghts  leading  to 
your  office  flicker  on.  As  you  push  to  open  the  office  door,  hghts  and  temperature  adjust 
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to  the  settings  you  picked  yesterday.  Meanwhile,  the  process  control  network  in  the 
manufacturing  area  sends  your  computer  the  latest  statistics. 

“Abruptly,  a  fire  alarm  system  warns  you  of  smoke  and  fire  in  a  section  of  the 
factory  floor.  It  also  alerts  the  local  fire  department  by  phone,  and  your  heating  and  air 
conditioning  die.  The  process  control  network  shuts  down  the  manufacturing  line,  the 
access  control  system  Usts  who  is  where  in  the  building  for  the  fire  department,  and  the 
lighting  control  network  turns  on  all  hghts  along  the  routes  to  the  emergency  exits.  All 
this  happens  painlessly  and  flawlessly”  [3]. 

This  example,  while  not  yet  possible,  demonstrates  the  power  of  the  control 
network.  An  eflfectrve  protocol  for  single-chip  computers  will  only  increase  this  power. 
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Calculating  System  Equations 


The  following  MATLAB  file  calculates  the  nonlinear  equations  governing  the 
ball/beam  system  using  Lagrange’s  method.  It  returns  three  different  sets  of  equations 
which  may  be  considered  by  the  user:  1 )  the  full  dynamics,  allowing  slippage  and 
ortliogonal  velocity  effect,  2)  a  simplified  model  ignoring  the  effect  of  the  orthogonal 
velocity  component,  and  3)  an  even  sunpler  model  ignoring  slipping  as  well. 


dispi' - *  +  +  FULL  MODEL  * - •  ) 

GlSp(  .f.  4. +  .4.  '  J 

KE1='  1/2’Ml*  ((ix*2+ (x*dch)  *2)  +  (1/2)  *  ( 2 /5 'Ml  *.R*2  )  *  (dx/R+dclG)  '2'  ; 

KE2=  ’  1/2*  (M2*L*2/12)  *dt;h*2  ’  ; 

K£=symcp (KEl , • + ’ , KE2 ) 

PE=' -Ml*G’x'sin(ch)  ' 

LAG=syTncp  (KE,  '  -  ’  ,  PE) 

Fx= ' -Bx*dx ' ; 

Tl=diff (LAG, -dx’ ) ; 

T2=syTnop  (diff(Tl,'x'),'*','dx'); 

T3=syraop (diff (Tl, 'dx' ) , ' • • , 'ddx' ) ; 

T4=symop (dif f (Tl , ' ch' ) , ' • • , 'dth' ) ; 

T5  =  symop(diff  (Tl,  'dth' )  ,  '  •  '  ,  'ddch'  )  ,- 
T6=diff (LAG, 'X' ) ; 

Tx  =  syTiiop  (T2  ,  '  +  '  ,  T3  ,  '  +  '  ,  T4  ,  '  +  ’  ,  T5  ,  '  -  ’  ,  T6  ,  ’  -  '  ,  Fx) 

%  col lecc (Tx , ' ddx ' ) 

%  collect (Tx, 'ddch' ) 

Fch= ' Tm-Bth*dth ' ; 

Ti=diff (LAG, 'dth' ) ; 

T2  =  syTTiop  (dif  f  (Tl ,'  X'  dx  ')  ; 

T3=symop (dif f (Tl ,' dx , 'ddx' ) ; 

T4=symop (dif f (Tl ,' ch ' dth '); 

T5=syTiiop(diff  (Tl,  'dth'  'ddth'  )  ,- 

T6=diff (LAG, ' th' ) ; 

Tth=symop (T2 , ' + ' , T3 , ' + ' , T4 , ' + ' , T5 , ' - ' , T6 , ' - ' , FCh) 

%  collect (Tch, ■ ddx ’ ) 

%  collect (Tth, ' ddth' ) 

[ddx, ddch] =solve (Tx, Tch, 'ddx, ddch' ) ; 

disp ( ' ddx ' ) 

for  i=l : 70 : length (ddx) 

disp  (ddx  (i. -mind +6  9,  length  (ddx)  )  )  ) 
end 
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disp { ' ddth ’ ) 

for  i=l : 70 : length (ddth) 

disp (ddth ( i : min ( i ^6  S , length (ddth) ) ) ) 
end 

%  return 

%  Now  substitute  in  some  numbers 
ddxl  =  subs (ddx,  '9.80621'  ,  'G' ) ; 
ddxl=subs (ddxl , ' 0 . 2 ’ , ' Ml ' ) ; 
ddxl=:subs  (ddxl ,  '0,45'  ,  ’  M2  '  )  ; 
ddxl = subs (ddxl 
ddxl  =  subs (ddxl ,  ' 0 . 01  * , *  R ' ) ; 
ddxl=subs (ddxl , ’ 0 , 001 ' , ' Bx ' ) ; 
ddxl  =  subs (ddxl ,  ' 0 . 01 ' ,  ' Bth ' )  ; 


ddthl=subs (ddth, ’9.60621',’G'); 
ddthl =subs ( ddthl , ' 0 . 2 ' , ' Ml ’ ) ; 
ddthl  =  subs (ddthl ,  ' 0 . 4  5 ’  ,  ' M2 ’ )  ; 
ddthl = subs ( ddthl ,'1.3','L'); 
ddthl=subs (ddthl, '0.01' , 'R' ) ; 
ddthl=:subs  iddthl,  ’  0.001'  ,  '  Bx '  )  ; 
ddthl = subs (ddthl ,'0.01’,’Bth’); 

disp ( 'ddxl' ) 

for  i=l : 70 : length (ddxl ) 

disp ( ddxl (i :min(i+69, length ( ddxl ) ) ) ) 
end 

disp ( *  ddthl ' ) 

for  i=l :70: length (ddthl) 

di sp ( ddthl (i:min(i>69, length ( ddthl ) ) ) ) 
end 

disp( '  +  +  +  -  +  +  +  +  ■  ) 

disp  (  ' +  end  full  model  +  +  +  + ’  ) 

disp  ( '  +  ♦  +  +  +  *-.  +  -.  +  +  ■.  +  +  -►  +  ■►  +  ++++++ +  +  +  *  +  +  +  '  > 
disp ( '  ' ) 

disp(  ’  +  +  '  ) 

disp  (' +  +  +  +  +  +  +  +  -.  +  +  +  SIMPLIFIED  MODEL  +  +++  +  +  +++  +  +  +') 
disp( ' ++++++++++++++++++++++++++++++++++++++++++++' > 

KE1=  '  1/2*M1’' (dx''2+ (x’dth)  ^2)  +  ( 1/2  )  ’  ( 2/5*Ml*R*2  )  *  (dx/R)  2  '  ; 

KE2= ' 1/2’ (M2’L‘2/12) ’dth*2 ' ; 

KE  =  symop  ( KEl ,  '  +  '  /  KE2 ) 

PE= ' -Ml»G*x*sin (th) ’ 

LAG=symop (KE, ' - ' , PE) 

Fx= ’ -Bx*dx ' ; 

Tl=diff (LAG, 'dx' ) ; 

T2=symop(diff (T1 x* dx ') ; 

T3=symop (diff (T1 , ' dx' ) , '  ”  , 'ddx' ) ; 

T4=symop(diff (Tl,  'th') , , 'dth') ; 

T5  =  symop (diff (Tl, 'dch' ) ,  , 'ddth' ) ; 

T6=diff (LAG, 'X' ) ; 

Tx=symop(T2, ■ + • , T3 , ' + ' , T4 , ' + ' , T5 , ' - ' , T6 , ' - ' , Fx) 

%  collect (Tx, ' ddx' ) 

%  collect (Tx, ' ddth' ) 
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Fth=  ’  Tm-Eth*dt:h  '  ; 

Tl^diff (LAG, 'dth' ) ; 

T2=symop (dif f (T1 , ’ x ' ) , ' * ' , ‘ dx ' ) ; 

T3  =  syTT\op  (dif  f  (T1 dx  ’  ddx '  )  ; 

T4=symop (diff(Tl, 'th') , , 'dth') ; 

T5  =  syTnop  (dif  f  (T1 ,  '  dth '  )  ,  '  *  ’  ,  ’  ddth '  )  ; 

T6=diff (LAG, ' th' ) ; 

Tth=symop (T2 , ’ + ' , T3 , ’ + ' , T4 , ' + ’ , T5 , ’ - ’ , T6 , ' > ' , Fth) 

%  collect (Tth, 'ddx' ) 

%  collect (Tth, 'ddth* ) 

[ddx , ddth] = solve (Tx , Tth . ' ddx , ddth ' ) ; 

disp { ' ddx ’ ) 

for  i=l : 70 : length (ddx) 

disp (ddx ( i : min ( i  +  6  9 , length (ddx) ) ) ) 
end 

disp ( ' ddth ' ) 

for  i  =  l:70:  length (ddth) 

disp (ddth {i:min(i+69, length (ddth) ) ) ) 
end 

%  Now  substitute  in  some  numJcers 
ddx  1  =  subs  (ddx,  '  9 . 8 062 1 '  ,  ’  G '  }  ,* 
ddxl =subs ( ddxl ,'0.2','Ml'); 
ddx 1  =  subs (ddxl ,  '0.45',  ’ M2 ' )  ; 
ddxl  =  subs  (ddxl ,  '  1 . 3  '  ,  ’  L  ’  )  ,* 
ddxl = subs (ddxl , ' 0 . 01 ’ , ' R ' ) ; 
ddxl=subs (ddxl ,  ' 0 . 001 ’  ,  ' Ex ' )  ; 
ddxl = subs (ddxl , ' 0 . 01 ' , ' Eth ' ) ; 

ddthl=subs (ddth, '9.80621', 'G'); 
ddthl  =  subs (ddthl ,  ’ 0 . 2  '  ,  ' Ml ’ )  ; 
ddthl=subs (ddthl ,  ' 0 . 45 ' ,  ' M2 ’ )  ; 
ddthl  =  subs (ddthl ,  '  1 .  3  '  ,  ' L ’ )  ; 
ddthl = subs (ddthl , ' 0 . 01 ' , ' R ' ) ; 
ddthl  =  subs (ddthl ,  ' 0 . 001 ' ,  ' Ex ' )  ; 
ddthl = subs (ddthl , '0.01' , ' Eth ' ) ; 

disp ( ' ddxl ' ) 

for  i=l : 70 : length (ddxl ) 

disp (ddxl ( i :min ( i+69 , length (ddxl ) ) ) ) 
e.nd 

disp ( ' ddthl ' ) 

for  i=l : 70 : length (ddthl ) 

disp (ddthl ( i : min ( i+6  9 , length (ddthl ) ) ) ) 
end 

disp  (  '  +  +  +  +  +  ++  +  -»-  +  +  +  +  +  +  +  +  +  +  +  +  +  -K  +  +  +  4--r  +  +  +  4.4-  +  4-  +  +  +  4--f ++  +  +  ’  ) 

disp (' ++++++++++  END  SIMPLIFIED  MODEL  ++++++++++'} 
diSp(  +  +  +  +  +  +  +  +  +  +  +  +  +  +  +  +  +  +  +  +  +  +  +  ) 
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Integrator  State  Feedback  Design 


The  following  MATLAB  code  acts  on  the  linearized  state-space  matrix  and 
calculates  five  gains  (for  the  fifth  order  system)  to  place  the  poles  in  the  user  specified 
location. 


■s  Linearization  and  Simulation  of  ball/beam  dynamics 


Ml=0.113; 

M2=0.455; 

Bx=0 . 01 ; 

Bth=0.01; 

G=9.80621; 

L= 1 . 0 ; 

x01=0;  x02=.5;  %Initial  and  final  ball  position 

%Use  final  position  in  formina  [A,H,C,D] 
x0  =  0; 

DEN=Ml*xO‘2+.M2*L‘2/2  ; 

A2=[0  1  0  0;  0  -5/7*Bx/Ml  5/7*G  0;  0  0  0  1;  Ml’G/DEN  0  0  -3th/DEN] ; 
Bz= [0  0  0  1/DEN] ' ; 

Cz= [1  0  0  0]  ; 

Dz  =  0; 


-1-.7*]  -l.l+.7*j  -l.l-.7*j  -2]  , -desired  poles 

cel=conv([i  -p(i)],[i  -p(2))); 
ce2=conv([l  -p(3)],(l  -p(4)]); 
cel=conv  (cel ,  ce2) 
ce=conv(cel, [1  -p(5)]); 
ce=ce  (2:6) 

Kbar=willt  ( Az ,  Bz ,  Cz ,  ce) 

K=-Kbar (5) 

%Kz=place (Az , Bz , p) ; 

Kz=Kbar (1:4) ; 

Kl=Kz (1) 

K2=Kz (2) 

K3=Kz (3) 

K4=Kz (4) 

Acl=Az-Bz*Kz ; 

t=0; .01:10; 

[num,den] =ss2cf (Acl , Bz , Cz , Dz) ; 
num=K*num; 

den=conv (den,  [l  0]  )  ; 

[numcl , dencl ] =cloop (num, den)  ; 
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step (numcl , dencl , t ) ; 

[Ai,Ei,Ci,Di] =tf2ss (numcl , dencl ) ; 

%U=ones (size  (t ) )  ; 

%U=x02*U; 

XXO=  [xOl  0  0  0]  '  ; 

%return; 

% [YY,XX] =lsim(Acl,B2,Cz,Dz,U, t,XXO) ; 

%  [YY,XX] =lsim(Ai,Bi,Ci,Di,U,t,XXO)  ; 

%plcr:  ( t ,  YY)  ;  grid;  figure{gcf); 

%Tm= -XX*Kz ' -Ml *G*x02 ;  %Motor  torque  to  apply 

%tt  =  t  ’  ; 


Appendix  A3 
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Additive  Clock  Operations 

The  PIC  processor  has  a  program  counter  that  increments  after  each  instruction. 
The  new  value  of  the  counter  will  be  the  address  in  program  memory  of  the  next  command 
that  it  executes.  On  a  GOTO  or  CALL  statement  (the  only  two  jumping  instructions),  the 
processor  loads  the  value  of  the  address  that  is  jumped  to  into  the  program  counter  before 
executing  the  juirq)  instruction.  This  is  how  it  knows  where  to  go  to  execute  the  next 
mstruction.  It  is  also  possible  to  simulate  a  jump  by  adding  a  number  directly  to  the 
program  counter.  The  program  counter  increments  after  it  executes  the  instruction  on  its 
address  line,  so  if  the  instruction  adds  a  number  to  it,  it  increments  this  by  one  more. 
Looking  at  the  following,  the  first  and  second  lines  save  the  third  character  of  the  message 
(the  command  byte)  into  a  register  called  Command.  The  program  counter  then 
increments  by  one  to  go  to  the  next  step.  In  this  next  step,  the  PIC  adds  the  value  just 
stored  in  the  command  register  the  present  value  of  its  program  counter  and  then 
mcrements  the  value  of  the  program  counter  by  one.  For  simpUcity.  assume  that  the 
message  was  the  same  as  the  example  message  earlier  and  that  the  program  counter  has 
the  value  of  the  line  numbers  in  the  code  below.  The  program  counter  currently  has  the 
value  2.  When  the  value  of  the  Command  register  (a  decimal  3)  is  added  to  it,  it  then 
contains  the  \  alue  5.  After  h  executes  this  addition  instruction,  it  increments  itself  by  one 
expecting  to  go  to  the  next  line.  Actually,  it  contains  the  value  6,  so  it  jumps  to  that  line. 
When  it  reaches  line  6.  it  executes  the  instruction  there  and  jumps  to  the  section  of  code 
labeled  Cmd3.  In  this  way,  h  is  able  to  use  the  value  of  the  third  byte  of  the  message  to 
execute  a  certain  command 


1 

movf 

Msg+3. W 

;  move 

third 

byte  of  message  into 

2 

movwf 

Command 

;  move 

W  reg 

into  Commang  reg 

3 

addwf 

PCL,  F 

;  add 

value  o 

f  Command  to  counter 

4 

gone 

Send_Token 

5 

goto 

Cmdl 

6 

goto 

Cmd2 

7 

goto 

Cmd3 

Appendix  A4 
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Node  2  Source  Code 


The  following  code  is  the  actual  machine  language  code  that  is  programmed  into 
node  2  of  the  network,  the  node  responsible  for  communicating  with  the  PC  as  well  as  the 
other  PIC  processors. 

;  "NODE2.SRC" 


DEVICE  PIC16C84 ,KS_OSC, WDT_OFF, PWRT_OFF, PROTECT_OFF 
; Registers 


ORG 

OCh 

TmpW 

DS 

1 

TmpSTAT 

DS 

1 

TmpINT 

DS 

1 

TttiP 

DS 

1 

Tmpl 

DS 

1 

Tmp2 

DS 

2 

CNT 

DS 

2 

i 

DS 

1 

CRCl 

DS 

1 

ComStat 

DS 

1 

ComReg 

DS 

1 

ComCnt; 

DS 

1 

DelCnc 

DS 

1 

ADDR 

DS 

2 

POSD 

DS 

1 

Pos 

DS 

1 

Fig 

DS 

1 

various  flag  bits 

Disp 

DS 

3 

digits  to  display  {up 

to  6,  BCD) 

DCnt 

DS 

1 

Msg 

DS 

1 

; Numeric 

constants 

F 

1 

LSB 

= 

0 

MSB 

= 

7 

RCF 

= 

ComStat . 0 

TXF 

= 

Comstat . 1 

CRCErr 

= 

ComStat , 2 

FERR 

= 

ComStat . 3 

OERR 

= 

ComStat . 4 

DTS 

= 

ComStat . 5 

toPC 

= 

Corns tat . 6 

EOMchr 

equ 

r  ^  1 

;  End-of -message 

character 

IntVEC 

equ 

10110000b 

;  GIE=1,  RTIE=1, 

INTE=:1 

RSI 

equ 

Fig. 7 

temporary  storage  for 

RS  status 

tmout 

equ 

Fig, 6 
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PHAlast  egu 

Fig. 5 

;  last  value  of  'PHA*  of  input  shaft  encoder 

msec 

100  equ 

Fig. 4 

;  1=100  msec  elapsed 

ch_pcs  equ 

Fig. 3 

;  ball  position  changed 

ch_pcsd  equ 

Fig. 2 

;  desired  position  changed 

firs 

t  equ 

Flg.l  ; 

l=first  character  received 

;  Pin 

assignments 

RX 

equ 

PORTB . 0 

TXl 

equ 

PORTA. 3 

TX 

equ 

PORTA . 2 

;  Signals  to  the 

40x2  LCD 

display  (data  is  sent  on  PORTB. 6  -  PORTB. 3) 

RS 

equ 

PORTB . 1 

RW 

equ 

PORTB . 2 

CLK 

equ 

PORTA . 4 

;  Signals  from  input  shaft 

encoder  (inputs) 

PHA 

equ 

PORTA . 0 

PH3 

equ 

PORTA . 1 

ORG 

OOh 

;Code  Space 

goto 

START 

ORG 

04h 

;ISR  Space 

goto 

ISR 

LUTl 

addwf 

2,  F 

ret  w 

’ POS (d) 

' ,  EOMchr 

LUT2 

addwf 

2,  F 

retw 

' POS  '  , 

EOMchr 

LUT3 

addwf 

2,  F 

retw 

•OK',  EOMchr 

ISR 

movwf 

TmpW 

;Save  contents  of  W  register 

swapf 

STATUS , W 

movwf 

TmpSTAT 

;Save  contents  of  STATUS  register 

bt  f  sc 

INTF 

call 

Receive 

btf  sc 

RTIF 

call 

Timer 

ENDISR 

swapf  TmpSTAT.W 


movwf 

STATUS 

;  Put 

contents  of 

STATUS  register  back 

swapf 

TmpW, F 

swapf 

TmpW, W 

;  Put 

contents  of 

W  register  back 

retf ie 


Timer”  handles  the  100  microsecond  timer  interrupts 
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Timer 

bcf 

RTIF 

clrf 

RTCC 

Shaft 

btf  sc 

PHAlasc 

goto 

:L0 

1 

\ 

btf  ss 

PHA 

i 

goto 

:L0 

j 

bsf 

ch_posd 

bsf 

DTS 

i 

btf  ss 

PHB 

i 

goto 

:  inc 

1 

:dec 

decf 

PosD,  F 

i 

movlw 

156 

subwf 

PosD,  W 

bcf  ss 

Z 

goto 

:L1 

movlw 

157 

movwf 

PosD 

goto 

:L1 

:  inc 

incf 

PosD,  F 

movlw 

100 

subwf 

PosD ,  W 

bt  f  ss 

Z 

goto 

:L1 

movlw 

99 

movwf 

PosD 

;  LI 

bsf 

tmout 

:L0 

bsf 

PHAlast 

btf  ss 

PKA 

bcf 

PHAlast 

; 

bsf 

tmout 

;  call 

PosD_Chg 

return 

START 

bsf 

RPO 

clrf 

INTCON 

; disable  interrupts 

movlw 

03h 

movwf 

05h 

; TRISA 

movlw 

Olh 

;  01h 

movwf 

06h 

;TRISB 

movlw 

10001000b 

movwf 

OPTION 

; Interrupt  on  falling  edge  of  BO 

bcf 

RPO 

movlw 

2 

movwf 

ADDR 

clrf 

PosD 

clrf 

Pos 

clrf 

Fig 

bsf 

ch_pos 

bsf 

chjosd 

bcf 

RCF 

bsf 

TXl 
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bsf 

TX 

; movlw 

5 

;movwf 

testcnt 

LCDprep 

call 

LCD_init 

call 

LCD^clear 

PrepO  movlw 

Msg 

movwf 

FSR 

Prepl  movlw 

INTVEC 

movwf 

INTCON 

;  goto 

print_ok 

MAIN  btfss 

tmout 

goto 

:M1 

bcf 

tmout 

call 

message 

:M1  btfss 

RCF 

goto 

MAIN 

;goto 

loop 

bcf 

RCF 

;  goto 

print_OK 

movf 

ComReg , W 

movwf 

0 

;  goto 

print_OK 

subl  w 

EOMchr 

btf  sc 

Z 

goto 

Process 

incf 

FSR,  F 

movf 

FSR,  W 

sublw 

2Fh 

btf  sc 

C 

goto 

Prepl 

;goto 

print^ok 

;  goto 

PrepO 

/Begin  processing 

message 

Process 

;  goto 

print^ok 

bsf 

toPC 

movlw 

Msg 

movwf 

FSR 

to  FSR 

movf 

0,  W 

btf  sc 

2 

goto 

New_Inf o 

sublw 

'  w 

btf  sc 

2 

goto 

CPU 

call 

CRC 

btfss 

2 

;move  address  of  Msg  register  to  FSR 
;  Enable  interrupts  (GIE  RTIE  and  INTE) 


;wait  for  receipt  of  bvte 
;Main  part  of  prograrr.  here 


;rnove  byte  into  current  Ms  a  reoister 


;prepare  for  next  byte 

;see  if  addressing  beyond  memory 


;  reenable  interrupts 
;end  of  buffer,  start  over 


;move  address  of  first  byte  (address) 

;read  address 
;  token  received 

; check  to  see  if  data  needs  to  be  sent 
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nop 

;goto 

pr int_ok 

movlw 

Msg 

movwf 

FSR 

movf 

ADDR, W 

; check  to  see  if  node  is  addressable 

yet 

btfsc 

Z 

; first  byte  is  defining  address 

movf 

0,W 

movwf 

ADDR 

movf 

0,W 

subwf 

ADDR, W 

btf  ss 

Z 

goto 

RetranstoPC 

/message  not  for  this  node 

;  call 

CRC 

;goto 

CRC 

; check  CRC 

PO 

movlw 

Msg+1 

/"From"  address 

movwf 

FSR 

movf 

o,w 

movwf 

ADDR-1 

/move  address  of  sending  byte  into 
/ADDR-^1  register 

’  Exec 

ute  instruct 

ion  specified 

by  message 

Comma 

nd 

incf 

FSR,  F 

movf 

0,W 

addwf 

PCL,  F 

CmdO 

goto 

New_Inf o 

Cmdl 

goto 

Chg___PosD 

Cnd2 

goto 

Chg_Pos 

Cmd3 

goto 

New_Infc 

/reserved  for  future  use 

Cmd4 

goto 

New_Inf o 

CmdE 

goto 

New_Inf o 

Cmd6 

goto 

New_Inf o 

Cmd7 

goto 

New^lnf o 

CmdS 

goto 

New_Inf o 

Cmd9 

goto 

New_Inf c 

CmdA 

goto 

New__Inf  0 

CmdB 

goto 

New_Inf o 

CmdC 

goto 

New__Inf  o 

CmdD 

goto 

New^Inf 0 

CmdE 

goto 

New_Inf o 

CmdF 

goto 

New_Inf o 

CPU 

bcf 

toPC 

call 

CRC 

btf  ss 

Z 

goto 

Send_Token 

;  goto 

print_ok 

movlw 

Msg  +  1 

movwf 

FSR 

movf 

0  ,  w 

sublw 

'  P' 

btf  ss 

z 
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goto 

New_Info 

/message  not  valid;  check  for  new 

info/pass  toke 

n 

PI  incf 

FSR,  F 

movf 

0,  w 

/read  address 

btf  sc 

z 

/token  received 

goto 

New_Inf o 

/check  to  see  if  data  needs  to  be  sent 

movf 

ADDR,  W 

btf  sc 

Z 

/check  to  see  if  node  is  addressable 

movf 

o,w 

•first  byte  is  defining  address 

movwf 

ADDR 

movf 

0,  W 

subwf 

ADDR,  W 

btfss 

Z 

;  goto 

print_OK 

goto 

Retrans 

message  not  for  this  node;  retransmit 

;call 

CRC 

check  CRC 

movlw 

Msg+3 

’’From"  address 

movwf 

FSR 

movf 

0,  W 

movwf 

ADDR^l 

move  address  of  sending  byte  into 

ADDR^l  registe: 

r 

goto 

Command 

;Cmdl  -  update 

the  desired  positior 

\  of  the  ball 

Chg_PosD 

movf 

Msg+  5 , W 

movwf 

PosD 

bsf 

chjposd 

;bsf 

DTS 

;  goto 

New_Inf o 

call 

message 

goto 

PosD_Chg 

;  goto 

Send_Token 

;Cmd2  -  update 

the  position  of  the 

ball 

Chg_Pos 

movf 

Msg-H3,  W 

movwf 

Pos 

bsf 

ch_pos‘ 

goto 

New_lnf o 

;Check  to  see  if  node  has  data  to  be  sent;  if  so,  send  that  data.  If 
not,  pass  token 
New_Inf o 

movf  Msg,W 

DTS  ;does  new  data  need  to  be  sent? 

goto  PosD_Chgr 

; Transmit  token  to  next  node  in  sequence 
Send_Token 

clrf  Msg 

movlw  EOMchr 

movwf  Msg+1 

btfss  toPC 


Send 

SendtoPC 
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goto 
.  goto 

/Change  desired  position  of  ball 
PosD_Chgr 


bcf 

DTS 

movlw 

Msg 

movwf 

FSR 

movlw 

Olh 

/movlw 

04h 

movwf 

0 

incf 

FSR,  F 

movlw 

02h 

movwf 

0 

incf 

FSR,  F 

movlw 

02h 

movwf 

0 

incf 

FSR,  F 

movf 

PosD, W 

movwf 

0 

incf 

FSR,  F 

movlw 

EOMchr 

movwf 

0 

call 

CRCCalc 

bt  f  ss 

toPC 

goto 

Send 

goto 

SendtoPC 

Chg 

bcf 

DTS 

movlw 

Msg 

movwf 

FSR 

movlw 

04h 

movwf 

0 

incf 

FSR,  F 

movlw 

02h 

movwf 

0 

incf 

FSR,  F 

movlw 

02h 

movwf 

0 

incf 

FSR,  F 

movf 

PosD , W 

movwf 

0 

incf 

FSR,  F 

movlw 

EOMchr 

movwf 

0 

call 

CRCCalc 

btf  ss 

toPC 

goto 

Send 

aoto  SendtoPC 


/request  from  PC  to  change  PosD 


/message  goes  to  node  4 


/message  is  from  mode  2 


/execute  command  2 


/request  from  PC  to  change  PcsD 


/message  goes  to  node  4 


/message  is  from  mode  2 


/execute  command  2 


/Transmit  data  in  Msg+n  to  Node  3  until  End  of  Message  byte  is  reached 

/Strip  WP  from  message 

Retrans 
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movlw 

Msg 

movwf 

FSR 

:R0  incf 

FSR,  F 

incf 

FSR,  F 

movf 

0,  W 

decf 

FSR,  F 

decf 

FSR,  F 

movwf 

0 

sublw 

EOMchr 

btf  sc 

Z 

goto 

:R1 

incf 

FSR,  F 

goto 

:R0 

:R1  call 

CRCCalc 

goto 

Send 

;Transmit  data 

in  Msg+n  to 

RetranstoPC 

goto 

SendtoPC 

;  "Send”  retransmits  back  < 

next  machine 

Send  movlw 

Msg 

movw'f 

FSR 

Sendl  movf 

0,  w 

movwf 

ComReg 

call 

XMIT 

movf 

0,  W 

sublw 

EOMchr 

btf  sc 

z 

goto 

PrepO 

incf 

FSR,  F 

goto 

Sendl 

;  "SendtoPC”  re 

transmits  b< 

to  next  machine 

SendtoPC 

movlw 

Msg 

movwf 

FSR 

StPl  movf 

0,  W 

movwf 

ComReg 

call 

XMITtoPC 

movf 

0,  W 

sublw 

EOMchr 

btf  sc 

Z 

goto 

PrepO 

incf 

FSR,  F 

goto 

StPl 

LCD__init 

bcf 

RSI 

ie  1  until  End  of  Messaae  bvte  is  reached 


Address  of  ”Msg"  into  W 
Load  FSR  with  Command  Byte 
Read  command 


Read  commiand 

check  for  end-of -messaae  bvte 


increment  FSR  reaister 


Address  of  "Msg”  into  W 
Load  FSR  with  Command  Byte 
Read  command 


Read  command 

check  for  end-of -message  byte 


increment  FSR  register 


LCD  Routines 


;  Send  instructions 
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call 

D41 

;  Delay  at  least  15  ms  (4x4.1  is  OK) 

call 

D41 

call 

D41 

call 

D41 

movlw 

00000011b 

call 

Send4 

;  send  lower  4  bits  of  [W] 

call 

D41 

movlw 

00000011b 

call 

Send4 

movlw 

00000010b 

;  Function  Set:  Sets  to  4-bit’ 

call 

Send4 

movlw 

OOlOlOOOb 

;  Function  Set:  2-line  display  and 

5x7  dot  character 

font 

call 

Sends 

;  movlw 

00001110b 

;  Display  ON/OFF  Control: 

movlw 

00001100b 

;  Display  ON/OFF  Control: 

call 

Sends 

movlw 

00000110b 

;  Entry  Mode  Set:  Increment  address 

by  1  and  shift  cu: 

rsor  to  right 

call 

Sends 

movlw 

00000001b 

;  Clear  display  and  place  cursor  on 

left 

call 

Sends 

bsf 

RSI 

;  Prepare  to  Send  data 

return 

LCD_clear 

bcf 

RSI 

;  Send  instructions 

movlw 

Olh 

;  Clear  display 

call 

Sends 

bsf 

RSI 

;  Send  data 

return 

LCD_home 

bcf 

RSI 

;  Send  instructions 

movlw 

02h 

;  Return  Cursor  to  Home  Position 

call 

Sends 

bsf 

RSI 

;  Send  data 

return 

LCD_white_space 

;  write  ’  '  characters  (total  number 

movwf 

Tmp 

;  is  [W] ) 

bsf 

RSI 

;  Send  data 

:L0  movlw 

20h 

;  ASCII  for  'space' 

call 

Sends 

decf S2 

Tmp,  F 

goto 

:L0 

return 

;  "GotoXY”  places 

the  cursor  at 

character  specified  in  [W]  recister 

Go COXY 

iorlw 

SOh 

;  command  to  set  DD  RAM  address 

bcf 

call 

bsf 

return 


RSI 

Sends 

RSI 


;  Send  instructions 
;  Send  data 


Sendrmnlr''°^  ^  nibbles  out  PORTS  bits  6-3) 


Sends  movwf 
movwf 


Tmp2  + 1 
Tmp2 


bcf 

CLK 

rrf 

Tmp2 ,  W 

movwf 

PORTS 

bcf 

RW 

bcf 

RS 

btf  sc 

RSI 

bsf 

RS 

bsf 

CLK 

nop 

nop 

K  ^  ^ 

CLK 

movf 

Tmp2+1 , 

Send4  movwf 

Tmp2 

bcf 

CLK 

swapf 

Tmp2,  F 

rrf 

Tmp2 ,  W 

movwf 

PORTS 

bcf 

RW 

bcf 

RS 

btf  sc 

RSI 

bsf 

RS 

bsf 

CLK 

nop 

nop 

bcf 

CLK 

;  Make  PORTS. 6  input 

bsf 

RPO 

bsf 

06h,  6 

bcf 

RPO 

;  Set/Reset 

bits  for  ) 

bcf 

RS 

bsf 

RW 

L3  bsf 

CLK 

nop 

nop 

bt  f  ss 

PORTS ,  6 

goto 

:L4 

bcf 

CLK 

bsf 

CLK 

bcf 

CLK 

Temporary  storage 
Temporary  storage 


place  upper  4  .bits  of  data  in  [w] 
Send  upper  4  bits  of  data 


clock  data  into  LCD 
Temporary  storage 


place  lower  4  bits  of  data  in  [w] 
Send  lower  4  bits  of  data 


clock  data  into  LCD 


clock  in  upper  4  bits 

check  for  busy 
not  busy 

still  busy,  so  clock  in  lower  4  b: 
and  discard 
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goto 

:L3 

:Ii4  bcf 

CLK 

bsf 

CLK 

bcf 

CLK 

bcf 

RW 

;  Return  P0RTB.6 

to  output  function 

bsf 

RPO 

bcf 

06h,  6 

bcf 

RPO 

return 

;  Delay  4.1  milliseconds  (w/  11.0592 

D41  movlw 

15 

movwf 

CNT 

clrf 

CNT-^1 

:L0  decfsz 

CNT+1,  F 

goto 

:L0 

decfsz 

CNT,  F 

goto 

:L0 

return 

;  Delay  long  time 

D4  10 

clrf 

CNT 

clrf 

CNT+1 

:L0  decfsz 

CNT-kI,  f 

goto 

:L0 

decfsz 

CNT.  F 

goto 

:L0 

return 

;  "Digit*'  sends  one  digit  out  to  the 

Digit  bsf 

RSI  ;  : 

andlw 

OFh 

icr  Iw 

30h 

call 

Send8 

return 

;  "message"  sends 

the  standard  data  ' 

message 

;print 

"POS  (d)  =  (^-/-)  .XX" 

:Lla  btfss 

ch_posd 

goto 

:L2a 

bcf 

ch_posd 

movlw 

15 

call 

GotoXY 

clrf 

i 

:L1  movf 

i,  W 

call 

LUTl 

movwf 

Tmpl  ;  1 

sublw 

EOMchr 

;  clock  in  lower  4  bits  and  discard 


Send  data 


temporary  storage 
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:N1 


:NEG 


:Nla 


:L2a 


:L2 


:N2 


btf  sc 

Z 

goto 

:N1 

movf 

Tmpl,  W 

call 

Sends 

incf 

i,  F 

goto 

:L1 

btf  sc 

PosD , MSB 

goto 

:NEG 

movlw 

1  1 

movf 

PosD, F 

btf  ss 

Z 

movlw 

•  +  * 

call 

Sends 

movlw 

•  .  ’ 

call 

Sends 

movf 

PosD ,  W 

movwf 

CNT 

clrf 

CNT^-1 

call 

to__dec8 

goto 

:Nla 

movlw 

t  _  1 

call 

Sends 

movlw 

•  ,  ' 

call 

Sends 

movf 

PosD,  w 

sublw 

0 

movwf 

CKT 

clrf 

CNT^l 

call 

rt 

O 

1 

Q. 

(D 

o 

CD 

swapf 

Disp,  W 

call 

Digit 

movf 

Disp,  W 

call 

Digit 

;print 

"POS=  (-^/ 

bt  f  ss 

return 

ch_pos 

bcf 

ch_pos 

movlw 

40h  +  15 

call 

GotoXY 

clrf 

i 

movf 

i,  W 

call 

LUT2 

movwf 

Tmpl 

sublw 

EOMchr 

btf  sc 

Z 

goto 

:N2 

movf 

Tmpl,  W 

call 

Sends 

incf 

i,  F 

goto 

:L2 

btf  sc 

Pos,MSB 

goto 

:NEG2 

temporary  storage 
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movlw 


:N2a 


:E1 


movf 

Pos ,  F 

btf  ss 

Z 

movlw 

•  +  ' 

call 

Sends 

movlw 

1  t 

call 

Sends 

movf 

Pos ,  W 

movwf 

CNT 

clrf 

CNT+1 

call 

to_dec8 

goto 

:N2a 

movlw 

t  _  1 

call 

Sends 

movlw 

1  1 

call 

Sends 

movf 

Pos,W 

sublw 

0 

movwf 

CNT 

clrf 

CNT-^1 

call 

to_decS 

swapf 

Disp,  W 

call 

Digit 

movf 

Disp,  W 

call 

Digit 

return 

_decfi"  is 

lOO's  digit; 

ile-byte 

counts  in  [C 

.sters  : 

[CNT^l :CNT] , 

:8 

movlw 

OFOh 

andwf 

Disp+1 

clrf 

Disp 

movf 

CNT,  W 

movwf 

Tmp2 

movf 

CNT  +  1,  W 

movwf 

Tmp2+1 

movlw 

64h 

subwf 

CNT,  F 

btf  sc 

C 

goto 

:E2b 

movlw 

1 

subwf 

CNT+1,  F 

btf  ss 

C 

goto 

:E1 

incf 

Disp+1,  : 

goto 

:E2a 

movf 

Tmp2 ,  W 

movwf 

CNT 

END  LCD  Routines 


[Tmp2+1 :Tmp2] 


100 's  digits  and  lower 
clear  proper  display  location 


save  coDv  for  later  restoration 


lOO's  diait 


lO's  diait 


restore  last  value 
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:Ela 

movf 

CNT,  W  ;  save  copy  for  later  restoration 

movwf 

Tmp2 

movlw 

10  ;  lO's  digit 

subwf 

CNT,  F 

bcf  ss 

C 

goto 

:E0  ;  I's  digit 

movlw 

lOh 

addwf 

Disp,  F 

goto 

:Ela 

:E0 

movf 

Tmp2,  W  ;  restore  last  value 

addwf 

Disp,  F 

return 

/Serial  Commun 

ications  routines 

;This 

subrout i 

ne  transmits  one  byte  of  data  in  Com.Reg  register  at  9600 

bps  . 

;The 

transmi t 

line  is  FORTH,  bit  1 

MM  IT 

bcf 

T>:f  ;byte  not  transmitted  yet 

movf 

INTCOK,W  /Store  entering  value  of  INTCON 

movwf 

Tmpint 

clrf 

INTCON  /temporarily  disable  all  interrupts 

movlw 

9  /Start  bit  +  8  data  bits  coming 

movwf 

ComCnt 

bcf 

c  ;  start  bit  in  carry 

:X0 

btf  ss 

C  /test  carry  data 

bcf 

TX 

bt  f  sc 

C 

bsf 

TX 

call 

Delay  /delay  for  1/9600  s 

rrf 

ComReg,F  shift  in  next  bit  of  data 

decf  S2 

ComCnt 

goto 

:X0 

bsf 

TX  /send  stop  bit 

;  call 

D41 

call 

Delay  /delay  for  1/9600  s 

movf 

Tmpint , w 

movwf 

INTCON  /restore  interrupt  values 

bsf 

XXF  /indicate  valid  transmission  of 

byte 

return 

;This 

subrout 

ine  transmits  one  byte  of  data  in  ComReg  register  at 

9600 

bps . 

;The 

transmit 

line  is  FORTH,  bit  1 

XMITtoPC 

bcf 

TXF  /byte  not  transmitted  yet 

movf 

INTCON, W  /Store  entering  value  of  INTCON 

movwf 

Tmpint 
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clrf 

INTCON 

;temporarily  disable  all  interrupts 

movlw 

9 

/Start  bit  +  8  data  bits  coming 

movwf 

ComCnC 

bcf 

C 

/Start  bit  in  carry 

btf  ss 

C 

/test  carry  data 

bcf 

TXl 

btf  sc 

C 

bsf 

TXl 

call 

Delay 

/delay  for  1/9600  s 

rrf 

ComReg, F 

/Shift  in  next  bit  of  data 

decf sz 

ComCnt 

goto 

:X0 

bsf 

TXl 

/send  stop  bit 

call 

Delay 

/delay  for  1/9600  s 

movf 

Tmpint , w 

movwf 

INTCON 

/restore  interrupt  values 

bsf 

return 

TXF 

/indicate  valid  transmission  of  byte 

;  "CRCCalc"  calculates  CRC  and  adds 
CRCCalc 


:L0 


:c  messaae 


CRC 


:L0 


movlw 

Msg 

Address  of  "Msg"  into 

W 

movwf 

FSR 

Load  FSR  with  Command 

Byte 

clrf 

CRCl 

CRC  check  holder 

movf 

0,  w 

Read  command 

sublw 

EOMchr 

check  for  end-of -message  byte 

btfsc 

Z 

goto 

:L1 

all  bytes  read,  check 

if  CRC  is 

movf 

0,  W 

Read  command 

addwf 

CRCl,  F 

incf 

FSR,  F 

goto 

:L0 

next  command  byte 

movf 

CRC1,W 

sublw 

0 

movwf 

CRCl 

movwf 

0 

incf 

FSR,  F 

movlw 

EOMchr 

movwf 

0 

return 

checks 

CRC  at  end  of  message 

movlw 

Msg 

Address  of  "Msg"  into 

W 

movwf 

FSR 

Load  FSR  with  Command 

Byte 

clrf 

CRCl 

CRC  check  holder 

movf 

0,  W 

Read  command 

sublw 

EOMchr 

check  for  end-of -message  byte 

btfsc 

2 

goto 

:L1 

all  bytes  read,  check 

if  CRC  is 

movf 

0,  W 

/  Read  command 

addwf 

CRCl,  F 

incf 

FSR,  F 

zero 


:L1 


goto 

:L0 

movf 

CRCl ,  F 

/ btf ss 

z 

/  goto 

print_ok 

/goto 

Send_Token 

/goto 

PO 

return 

next  command  byte 


CRC  failed,  ignore  message 
CRC  OK,  continue  processing 


Receive  one  byte  of  data  at  9600  bps  and  store  it  in  ComReg  register. 
This  routine  is  called  by  the  ISR  when  the  INTF  flag  is  set. 

Uses  PORT  B,  bit  0  (interrupt  pin) 


bcf 

RCF 

movl  w 

8 

movwf 

ComCnt 

call 

HDelay 

btf  sc 

RX 

goto 

RDone 

call 

Delay 

bsf 

portb,  7 

bt  f  ss 

RX 

bcf 

C 

btf  sc 

FJC 

bsf 

C 

rr  f 

ComReg 

bcf 

portb,  7 

decf sz 

ComCnt , F 

goto 

:R0 

call 

HDelay 

bsf 

RCF 

bcf 

IITTF 

/ decf sz 

testcnt , F 

return 

bsf 

ch_pos 

movf 

ComReg, W 

movwf 

Pos 

call 

message 

goto 

loop 

;byte  not  received  yet 


delay 

for  half  of  time 

check 

again 

for  start  bi 

exit  i 

f  not 

proper  start 

delay 

unt  i  1 

midpoint  of 

/delay  until  start  of  stop  bit 
/indicate  valid  reception  of  byte 


' .  DELAY  subroutine - 

/delays  are  set  for  9600  baud  using  11.05  MHz  crystal 


Delay  movlw 

45 

movwf 

DelCnt 

:D0  decfsz 

DelCnt 

goto 

:D0 

Hdelay 

movlw 

45 

movwf 

DelCnt 

:D1  decfsz 

DelCnt , F 

goto 

:D1 

return 
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print_OK 


nop 

call 

LCD_clear 

clrf 

i 

movf 

i,  W 

call 

LUT3 

movwf 

Tmpl 

sublw 

EOMchr 

btf  sc 

2 

goto 

loop 

movf 

Tmp  1 ,  W 

call 

Sends 

incf 

i,  F 

goto 

:L2 

message 

nop 

bt  f  ss 

first 

return 

call 

LCD_clear 

m.ovlw 

Msg 

movwf 

FSR 

movf 

0,  W 

sublw 

EOMchr 

btf  sc 

Z 

goto 

loop 

movf 

0,  w 

movwf 

CNT 

clrf 

CNT^^l 

call 

to_dec8 

swapf 

Disp,  W 

call 

Digit 

movf 

Disp,  W 

call 

Digit 

movlw 

'  ' 

call 

Sends 

incf 

FSR,  F 

goto 

:L2 

temporary  storage 


Appendix  A5 


Node  3  Source  Code 

The  following  code  is  the  actual  machine  language  code  that  is  programmed  into 
node  3  of  the  netw'ork,  the  node  responsible  for  monitoring  camera  output  and 
communicating  this  information  with  the  motor-controlling  node. 

;  "NODE3.SRC" 


DEVICE  F:C16C74 , HS_OSC, WDT  OF?,PWRT  OFF, PROTECT  OFF 


; Registers 


Trr*pW 

C'RG 

DS 

2  Oh 

1 

TmpSTAT 

DS 

1 

Tmpint 

DS 

j. 

CRCl 

DS 

1 

ComStat 

DS 

1 

ComReg 

DS 

1 

ComCr.t 

DS 

1 

DelCnt 

DS 

1 

CKT 

DS 

2 

ADDR 

DS 

2 

Pos 

DS 

1 

Vel 

DS 

1 

RowCnt 

DS 

1 

lent 

DS 

1 

Msg 

DS 

1 

; Numeric 

constants 

F 

= 

1 

LSB 

= 

0 

MSB 

= 

7 

Row 

= 

140 

;RCF 

ComStat . 0 

TXF 

= 

Comstat . 1 

CRCErr 

= 

ComStat . 2 

DTS 

= 

ComStat . 3 

SIP 

= 

ComStat . 4 

EOMchr 

1  1 

INTVEC 

= 

11001000b 

RTCC 

= 

TMRO 

RTIF 

TOIF 

;Pin  assignments 

;  End-of -message  character 


Horiz 

equ 

PORTB . 0 

Vert 

equ 

PORTE . 4 

CompOut 

equ 

PORTE , 1 

RCF 

equ 

PORTB . 2 

ORG 

OOh 

goto 

START 

ORG 

04h 

ISR  movwf 

TmpW 

swapf 

STATUS , W 

movwf 

TmpSTAT 

btf  sc 

RBIF 

call 

Vert Int 

btf  sc 

INTF 

call 

Horint 

btf  sc 

RCIF 

call 

RCInt 

ENDISR 

swapf 

TmpSTAT, W 

movwf 

STATUS 

swapf 

TmpW , F 

swapf 

TmpW, W 

retf ie 

RCInt  ;btfsc 

FERR 

/goto 

Send_Token 

/goto 

loop 

/btf sc 

OERR 

/goto 

Send_Token 

/  goto 

loop 

movf 

RCREG, W 

register 

movwf 

0 

sublw 

EOMchr 

btf  sc 

Z 

bsf 

RCF 

incf 

FSR,  F 

movf 

0,  W 

/ movl w 

10101010b 

/movwf 

PORTD 

return 

Horint 

bcf 

INTF 

decf  sz 

RowCnt 

return 

bsf 

RPO 

movlw 

01000001b 

movwf 

OPTION 

bcf 

RPO 

movf  Pos,W 


;Test  for  framing  error 


;Test:  for  overrun  error 


;Recover  daoa  byre  and  store  it  in  a 


Clear  interrupt  flag. 

If  not  desired  interrupt,  go  back 
and  wait  for  next  row. 


/Change  prescaler  to  WDT  ;l:4  on  RTCC 
;Age  position  variable 
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movwf 

clrf 

:H1  btfsc 
goto 
movf 
sublw 
btfsc 
goto 
movf 
movwf 
goto 

: H2  movf 

bsf 
movw'f 
movl  w 
subwf 
comf 
incf 

:H3  movlw 
bs  f 
movwf 
bcf 
bcf 

return 

Vert Int 

movlw 

movwf 

bcf 

bcf 

:V1  btfsc 
goto 
bsf 
bsf 
mov  1  w 
movwf 
bcf 
bcf 
bcf 

return 

START 

clrf 

bsf 

movlw 

movwf 

movlw 

movwf 

movlw 

clrf 

movlw 

movwf 

clrf 

clrf 


Pos  +  1 
RTCC 
CompOut 
:H2 

RTCC, W 

70 

C 

:H1 

PoS+1 , W 

Pos 

:H3 

RTCC, W 
PORTE . 7 
Pos 
35 

Pos ,  F 
Pos ,  F 
Pos ,  F 
01000100b 
RPO 

OPTION 

RPO 

INTE 


96 

RTCC 

RTIF 

PORTE . 7 

RTIF 

:V1 

INTE 

RPO 

01000001b 

OPTION 

RPO 

RBIF 

INTF 


INTCON 

RPO 

01000100b 

OPTION 

01110011b 

TRISB 

OOh 

TRISA 

lOOOOOOOb 

TRISC 

TRISD 

TRISE 


; to  use  to  find  velocity. 

;Test  the  comparator  output 

;ball  not  found 

;use  last  value  of  position  for  ball 

;Move  the  value  of  the  timer  into  a 
»2register  for  storing  the  position. 

.'Change  prescaler  back  to  1:32 
.'Disable  horizontal  interrupt 

.'Wait  for  5089>50S2  clock  pulses 

.'Enable  horizontal  interrupt. 

Clear  interrupt  flag. 

Clear  flag  from  unwanted  hor.  syncs 
Return  and  wait  for  the  hor.  syncs 


; Interrupt  on  rising  edge  of  RB . 0 
;and  set  prescaler  to  1:32  on  RTCC 
;Use  pins  RB.0,1,4  as  input 
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movlw 

00100000b 

movwf 

PIEl 

bcf 

RPO 

call 

RS232 

movlw 

lOlOlOlOb 

movwf 

PORTD 

clrf 

Pos 

;Sec  inicial  posicion  co  zero 

clrf 

Vel 

;Sec  inicial  velocicy  co  zero 

movlw 

Row 

movwf 

RowCnc 

movlw 

3 

movwf 

ADDR 

bsf 

CREN 

PrepO 

movlw 

Msg 

movwf 

FSR 

movlw 

INTVEC 

movwf 

INTCON 

bcf 

RCF 

;goto  Send_ 

_Token 

MAIN 

m.ovf 

RowCnc , F 

If  posicion  was  jusc  fccnd  \i.e.--che 

nop 

righc  row  was  jusc  ccmpleced 

btf  sc 

Z 

and  cherefore  RowCnc  is  now  zero) , 

nop 

updace  che  velocicy  of  Che 

call 

VELCALC 

ball. 

bcf  ss 

RCF 

goto 

MAIN 

;  Begi: 

n  prcessing 

message 

Process 

;goco 

loop 

movlw 

Msg 

movwf 

FSR 

move  address  of  firsc  byce  cc  FSR 

movf 

0,  W 

read  address 

bcf  sc 

Z 

coken  received 

goco 

New__lnf  c 

check  CO  see  if  daca  needs  co  be  sene 

call 

CRC 

bcf  ss 

Z 

goco 

loop 

movlw 

Msg 

movwf 

FSR 

movf 

ADDR, W 

bcf  sc 

Z  ; 

: check  CO  see  if  node  is  addressable 

movf 

0,  W  ; 

:  first  byte  is  defining  address 

movwf 

ADDR 

movf 

0,  W 

subwf 

ADDR, W 

bcf  ss 

Z 

;  goco 

loop 

goco 

Recrans 

-message  not  for  this  node 

;goco 

CRC 

-  check  CRC 

PO 

incf 

FSR,  F 

:move  next  byce  inco  FSR  regiscer 
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movf 

0,  W 

movwf 

ADDR+l 

; Execute  inst 

ruction  specified 

Command 

incf 

FSR,  F 

movf 

0,  W 

addwf 

PCL 

CmdO 

goto 

New_Inf o 

Cmdl 

goto 

New_Inf o 

Cnd2 

goto 

New_Inf o 

Cmd3 

goto 

New_Inf o 

Cmd4 

goto 

New_Inf o 

Cmd5 

goto 

New  Info 

Cmd6 

goto 

New  Info 

Cmd7 

goto 

New  Info 

Cmd8 

goto 

New  Info 

Cm,d5 

goto 

New  Info 

CmoA 

goto 

New  Info 

CmdB 

goto 

New  Info 

CmdC 

got  o 

New  Info 

CmdD 

goto 

New  Info 

CmdE 

goto 

New  Info 

Cmdr 

goto 

New  Info 

;  Chec 

:k  to  see 

if  node  has  data 

not , 

pass  token 

New  I 

nf  o 

movf 

Msg,  w 

btf  sc 

DTS 

goto 

Update 

goto 

Send^Token 

; Update  the  li 

near  position  and 

Update 

bcf 

DTS 

movl  w 

Msg 

movwf 

FSR 

movlw 

4 

movwf 

0 

incf 

FSR,  F 

movlw 

3 

movwf 

0 

incf 

FSR,  F 

movlw 

1 

movwf 

0 

incf 

FSR,  F 

movf 

Pos ,  W 

movwf 

0 

incf 

FSR,  F 

movf 

Vel,W 

movwf 

0 

incf 

FSR,  F 

;move  address  of  sending  byte  into 
;ADDR-t-i  register 


; reserved  for  future  use 


;does  new  data  need  to  be  sent? 
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movlw 

movwf 

call 

aoco 


EOMchr 

0 

CRCCalc 

Retrans 


/Transmit  token  to  next  node  in  sequence 
Send_Token 

clrf  Msg 

movlw  EOMchr 

movwf  Msg+1 

goto  Retrans 

/Transmit  data  in  Msg+n  to  Node  3  until  End  of  Message  byte  is  reached 
Retrans 

goto  Send 

/goto  PrepO 

/  "CRCCalc"  calculates  CRC  and  adds  it  to  message 
CRCCalc 


:  LI 


;  "CR; 
CRC 


:L0 


:L] 


movlw 

Msg 

movwf 

FSR 

clrf 

CRCl 

m.ovf 

0,  w 

sublw 

EOMchr 

btfsc 

Z 

goto 

:L1 

movf 

0 ,  W 

addwf 

CRCl,  i 

incf 

FSR,  F 

goto 

:L0 

movf 

CRC1,W 

sublw 

0 

movwf 

CRCl 

movwf 

0 

incf 

FSR.  F 

movlw 

EOMchr 

movwf 

return 

0 

r"  checks 

CRC  at  enc 

movlw 

Msg 

movwf 

FSR 

clrf 

CRCl 

movf 

0,  w 

sublw 

EOMchr 

btfsc 

Z 

goto 

:L1 

movf 

0,  W 

addwf 

CRCl.  F 

incf 

FSR,  F 

goto 

:L0 

movf 

return 

CRCl.  F 

Address  of  "Msg"  into  W 
Load  FSR  with  Command  Byte 
CRC  check  holder 
Read  command 

check  fcr  end-of -message  byte 

all  bytes  read,  check  if  CRC  is  ze: 
Read  com.mand 


next  command  byte 


Address  cf  "Msg"  into  W 
Load  FSR  with  Command  Byte 
CRC  check  holder 
Read  command 

check  for  end-of -message  byte 

all  bytes  read,  check  if  CRC  is  zero 
Read  command 


next  command  byte 
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"Send"  retransmits  back  command 


next 

machine 

Send 

movf 

INTCON, W 

movwf 

Tmpint 

clrf 

INTCON 

bsf 

SIP 

movlw 

Msg 

movwf 

FSR 

SO 

movf 

0,  W 

movwf 

ComReg 

bcf 

CREN 

bsf 

RPO 

bsf 

TXEN 

bcf 

RPO 

:X0 

btf  ss 

TXIF 

goto 

:X0 

XMIT 

movf 

ComReg , W 

movwf 

TXREG 

movf 

0,  W 

subl  w 

EOMchr 

btf  sc 

2 

goto 

:S1 

:S0a 

incf 

FSR,  F 

goto 

SO 

:S1 

bsf 

RPO 

:Sla 

bt  f  ss 

TRMT 

goto 

:Sla 

bcf 

t>:en 

bcf 

RPO 

bsf 

CREN 

movf 

Tmpint , W 

movwf 

INTCON 

goto 

PrepO 

RS232  bsf 

RPO 

movlw 

00100000b 

movwf 

TXSTA 

movlw 

32 

movwf 

SPBRG 

bcf 

RPO 

movlw 

10000000b 

movwf 

RCSTA 

return 

string  for  checking  or  passing  on  to 
store  entering  value  of  INTCON 

Address  of  "Msg"  into  W 
Load  FSR  with  Command  Byte 
Read  command 

Disable  reception 

Wait  until  transmit  buffer  is  clear 

Read  command 

check  for  end*of -message  byte 

increment  FSR  register 


restore  interrupt  values 

Setup  transmit 

9600  baud  using  20  MHz  crystal 

Enable  asynchronous  serial  port 


. - DELAY  subroutine - 

/delays  are  set  for  9600  baud  using  20  MHz  crystal 


Delay  movlw 
movwf 


82 

DelCnt 
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:D0  decfsz 

DelCnt 

goto 

Hdelay 

:D0 

movlw 

82 

movwf 

DelCnt 

:D1  decfsz 

DelCnt , 

goto 

return 

;D1 

loop  clrf 

INTCON 

movf 

Msg+1 ,  W 

addlw 

32 

movwf 

PORTD 

movlw 

51 

movwf 

lent 

:11  call 

D410 

decfsz 

lent 

goto 

:11 

;bsf 

CREN 

goto 

loop 

;  Delay  4.1  mi 

11 iseconds 

D4 1  movlw 

15 

movwf 

CNT 

clrf 

CNT^l 

:L0  decfsz 

CNT-^1,  ] 

goto 

:L0 

decfsz 

CNT.  F 

goto 

return 

;L0 

;  Delay  long  t 
D410 

ime 

clrf 

CNT 

clrf 

CNT-1 

:L0  decfsz 

CNT^l,  1 

goto 

:L0 

decfsz 

CNT.  F 

goto 

return 

VELCALC 

:L0 

movf 

POS+1 . W 

subwf 

Pos ,  w 

movwf 

Vel 

movlw 

nop 

Row 

movwf 

RowCnt 

movf 

Pos .  w 

movwf 

PORTD 

bsf 

DTS 

11 . 0592  MHz  crystal) 


Subtract  the  old  position  from  new 
and  store  the  result  in 
the  Vel  register. 

Get  the  correct  row  back  in  the 
RowCnt  register  in  preparation  for 
next  vertical  sync. 


return 


Appendix  A6 


Node  4  Source  Code 

TTie  following  code  is  the  actual  machine  language  code  that  is  programmed  into 
node  4  of  the  netw'ork,  the  node  responsible  for  controlling  the  motor  which  turms  the 
beam 


"NODE4 .SRC" 


DEVICE  PIC16C74 , HSOSC, WDTOFF, PWRT  OFF, PROTECT  OFF 


EECONTROL 

ORG 

DS 

20h 

1 

EEADDR 

DS 

1 

EEDATAH 

DS 

1 

EEDATAL 

DS 

1 

EEOP 

DS 

1 

EECNT 

DS 

1 

TmpW 

DS 

1 

TmpSTAT 

DS 

1 

K 

DS 

5 

Tmp 

DS 

3 

Tmpl 

DS 

1 

DelCnt 

DS 

1 

AC3 

DS 

3 

ACC 

DS 

1 

ComStat 

DS 

1 

ComReg 

DS 

1 

ADDR 

DS 

2 

PosE 

DS 

2 

PosD 

DS 

1 

Pos. 

DS 

1 

PosOld 

DS 

1 

Vel 

DS 

1 

Ang 

DS 

1 

AngVel 

DS 

1 

KXl 

DS 

2 

KX2 

DS 

2 

KX3 

DS 

2 

KX4 

DS 

2 

KX 

DS 

2 

SIGN 

DS 

1 

CRCl 

DS 

1 

CNT 

DS 

2 

i 

DS 

1 

Eint 

DS 

2 

Tmpint 

DS 

1 

Msg 

DS 

1 
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;NuTneric  constants 


F 

= 

1 

LSB 

= 

0 

MSB 

= 

7 

RCF 

= 

ComStat . 0 

TXF 

= 

Comstar . 1 

CRCErr 

= 

ComStat . 2 

DTS 

= 

ComStat . 3 

SIP 

= 

ComStat . 4 

EOMchr 

= 

1  ^  1 

;Pin  assignments 

; Shaft 

encoder 

related  pins 

Aout 

equ 

PORTB . 0 

; ( input) 

Bout 

equ 

PORTS . 5 

;  ( input ) 

;Motor 

controller-related  pins 

Phase 

equ 

PORTB . 1 

;  (output ) 

; EEPRCM 

-related  pins 

CS 

equ 

PORTA . C 

; (output 

CLK 

equ 

PORTA. 1 

;  (output ) 

DI 

equ 

PORTA. 2 

;  (output } 

DO 

equ 

PORTA . 3 

;  ( input ) 

ORG 

OOh 

goto 

START 

ORG 

04h 

ISR  mcvwf 

TmpW 

;Save  contents  of  W  register 

swapf 

STATUS , W 

movwf 

TmpSTAT 

;Save  contents  of  STATUS  register 

btfss 

RCIF 

;Test  receive  interrupt  flag 

call 

RCINT 

btf  sc 

INTF 

; Check  for  source  of  interrupt  and 

call 

PosUpdate 

;gc  to  the  appropriate  routine 

btf  sc 

TOIF 

call 

VelUpdate 

ENDISR 

swapf 

TmpSTAT, W 

movwf 

STATUS 

;Put  contents  of  STATUS  register 

swapf 

TmpW,  F 

swapf 

TmpW,  W 

; Put  contents  of  W  register  back 

retf  ie 

RCINT 

;btf sc 
;  goto 
;btf sc 
;goto 


FERR 

Send_Token 

OERR 

Send  Token 


;Test  for  framing  error 
;Test  for  overrun  error 
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movf 

RCREG,W 

movwf 

0 

sublw 

EOMchr 

btf  sc 

Z 

bsf 

RCF 

incf 

FSR,  F 

movf 

return 

0,W 

; Recover  data  byte  and  store  it 


"  PosUpdate" 


PosUpdate 

;This  part  of  the  interrupt  service  routine  is  called  when  pin  Aout 
;alone  changes  value  in  a  positive  direcion.  It  determines  which  way 
;the  track  moved  and  updates  the  position  vectors  associated  with  the 
;  track,  Ang  and  Ang-fl,  accordingly. 


ADDPos 


SUBPos 


bcf 

INTF 

bt  f  ss 

Bout 

goto 

ADDPos 

goto 

SUBPos 

j 

incf 

Ang ,  F 

; btf sc 

Z 

;  incf 

Ang'^  1 ,  F 

movf 

Ang ,  W 

movw'f 

return 

PORTD 

movlw 

1 

subwf 

Ang,  F 

;btf ss 

C 

;decf 

Ang+1 , F 

movf 

Ang ,  W 

movwf 

return 

PORTD 

; Clear  the  interrupt  flag 
;Determine  the  direction  that  the 
; motor  moved  by  polling  pin  3 


; . . . . . "VelUpdate" . - . 

VelUpdate 

;When  50,000  instructions  have  passed  (approximately  10  ms), 
;this  part  of  the  interrupt  service  is  called.  It  determines 
; the  velocity  of  the  motor  by  subtracting  from  the 
;most  recent  position  of  the  motor  the  last  saved  position. 


bcf 

TOIF 

/Clear  the  interrupt  flag 

movf 

PosOld, W 

subwf 

Ang,  W 

/Subtract  old  position  from  new 

movwf 

AngVel 

;  movf 

Ang+1 ,  W 

btf  ss 

C 

;decf 

Ang+1 ,  W 

; movwf 

AngVel+1 
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;  movf 

PosOld+1 , W 

;  subwf 

AngVel+1, F 

movf 

Ang,  W 

movwf 

PosOld 

;  movf 

Ang+1 ,  W 

; movwf 

PosOld+l 

movf 

AngVel , W 

movwf 

PORTD 

return 

;Put  contents  of  position  registers 
;into  old  position  registers 


Start  of  Main  Code  Space 


movlw 

Msg 

movwf 

FSR 

bsf 

RPO 

; Sankl 

movlw 

OlOOOOllt 

/Interrupt  on  low  to  hicr.  transi 

movwf 

OPTION 

clrf 

INTCON 

movlw 

00001000b 

movwf 

TRISA 

mo  V 1  w 

00100001b 

movwf 

TRIS5 

movlw 

10000000b 

movwf 

TRISC 

movlw 

0 

movwf 

TRISD 

movlw 

0 

movwf 

TRISE 

movlw 

00100000b 

movwf 

PIEl 

bcf 

RPO 

movlw 

01010101b 

movwf 

PORTS 

bcf 

RPO 

movlw 

00000100b 

movwf 

T2CON 

; Prescaler  =  1,  TMR2  is  on 

bsf 

RPO 

movlw 

OFFh 

movwf 

PR2 

; PWM  Frequency  =  19.53  kHz 

bcf 

RPO 

; movlw 

5 

; movwf 

DrvCnt 

movlw 

OOOOllOOb 

movwf 

CCPICON 

; PWM  mode,  8-bit  resolution 

movlw 

200 

movwf 

CCPRIL 

call 

RS232 

;Set  up  PIC16C74  for  serial  comm 

clrf 

PosD 
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clrf 

Pos 

clrf 

Vel 

clrf 

Ang 

clrf 

AngVel 

clrf 

Hint 

clrf 

Eint +  1 

movlw 

4 

movwf 

ADDR 

bsf 

CREN 

PrepO 

movlw 

Msg 

movwf 

FSR 

Prepl 

movlw 

11110000b 

movwf 

INTCON 

bcf 

RCF 

movlw 

5 

movwf 

i 

MAIN 

movf 

PosD , W 

mcvv,’f 

PosE 

movf 

Pos ,  w 

subwf 

PosE, W 

brf  ss 

PosE, MSB 

goto 

:  Inc 

:Dec 

movlw 

1 

subwf 

Eint , F 

btf  ss 

C 

decf 

Eint +1 , F 

movf 

Eint-^1,  W 

sublw 

128 

btf  ss 

2 

goto 

:  Cont 

movlw 

129 

movwf 

Eint  + 1 

goto 

:  Cont 

:  Inc 

incf 

Eint , F 

btf  sc 

2 

incf 

Eint+1 , F 

movf 

Eint+1 , W 

sublw 

128 

btf  ss 

2 

goto 

:  Cont 

movlw 

255 

movwf 

Eint 

movlw 

127 

movwf 

Eint  +  1 

;  goto 

Send_Token 

:  Cont 

;goto 

MAIN 

r  1/64’^ 

(163 . 84'^ Kl) 

♦ ( lOO^Pos) 

movf 

K+1,  W 

movwf 

ACC 

movf 

Pos  ,  W 

;  (GIE, FIE.RBIE.TOIE) 


;  PosE  =  PosD 


Pcs 


movwf 

ACB 

call 

Mult 

bcf 

C 

rrf 

ACB+1, F 

rrf 

ACB,  F 

bcf 

C 

rrf 

ACB+1, F 

rrf 

ACB,F 

bcf 

C 

rrf 

ACB+1, F 

rrf 

ACB,  F 

bcf 

C 

rrf 

ACB-^1,  F 

rrf 

ACB,  F 

bcf 

C 

rrf 

ACB  +  1,  F 

r  r  f 

ACB,  F 

bcf 

C 

rrf 

ACB^l ,  F 

rrf 

ACB,  F 

movf 

ACB,  W 

movwf 

KXl 

movf 

ACB-1,W 

movwf 

KX1-.1 

( 128*K2) -Vel 

movf 

K+2  ,  W 

movwf 

ACC 

movf 

Vel,W 

movwf 

ACB 

call 

Mult 

bcf 

C 

rlf 

ACB,  F 

rlf 

ACB-kI  ,  F 

movf 

ACB,  W 

movwf 

KX2 

movf 

ACE-hl ,  W 

movwf 

KX2^1 

* (51 .473*K3) 

*  (159 . 15*Ang) 

movf 

K+3  ,  W 

movwf 

ACC 

movf 

Ang ,  W 

movwf 

ACB 

call 

Mult 

bcf 

C 

rrf 

ACB  +  1 ,  F 

rrf 

ACB,  F 

bcf 

C 

rrf 

ACB  +  1 ,  F 

rrf 

ACB,  F 

bcf 

C 

rrf 

ACB+1, F 

rrf 

ACB,  F 

bcf 

rrf 

rrf 

bcf 

rrf 

rrf 

movf 

movwf 

movf 

movwf 

;1*  {160.854*K4) * 
movf 
movwf 
movf 
movwf 
call 
movf 
movwf 
movf 
movwf 

;Add  and  >:>:2 

movf 
addwf 
brf  sc 
incf 
movf 
addwf 


C 

ACE-^l,  F 
ACB,  F 
C 

ACB-kI,  F 
ACB,  F 
ACB,  W 
KX3 
ACB-fl 
KX3  +  1 

(1.5915*AngVel) 
K-4  ,  W 
ACC 

AngVel . W 
ACB 
Mult 
ACB,  W 
?CX4 

AC3-h1,W 

KX4^1 

(result  in  KX2) 
KXl,  W 
?CC2,  F 
C 

KX2-^1 ,  F 
KXl^l , W 
K>:2  ^  1 ,  F 


;Add  KX3  and  rC^:4 
movf 
addwf 
btf  sc 
incf 
movf 
addwf 


(result  in  KX4 ) 
KX3,  W 
K:X4  ,  F 
C 

KX4-H1,  F 
KX3  +  1,W 
KX4  +  1,  F 


;Add  KXl,  KX2, 
movf 
addwf 
btf  sc 
incf 
movf 
addwf 


KX3,  and  KX4 
KX2,  W 
KX4  ,  F 
C 

KX4+1, F 
KX2+1, W 
KX4+1, F 


(result  in  KX4 ) 


;Take  negative 
comf 
comf 
incf 
btf  ss 
incf 


of  answer 
KX4,  F 
KX4  +  1,  F 
KX4,F 
Z 

KX4  +  1,  F 


Add  answer 

to  Eint  (result 

movf 

Eint , W 

addwf 

KX4 

bt  f  sc 

C 

incf 

Eint+1 , F 

movf 

Eint  +  1 , W 

addwf 

10(4  +  1 

/CHECK 

FOR  BAD  ADDITION 

movlw 

KX4  +  1 

movwf 

CCPRIL 

bt  f  ss 

RCF 

goto 

MAIN 

/Begin  processing 

message 

Process 

movlw 

Msg 

movwf 

FSR 

movf 

0,  W 

btfsc 

Z 

goto 

New  Info 

call 

CRC 

bt  f  ss 

Z 

goto 

loop 

movlw 

Msg 

movwf 

FSR 

movf 

ADDR, W 

btfsc 

Z 

movf 

0.  w 

movwf 

ADDR 

movf 

0,  w 

subwf 

ADDR , W 

btf  ss 

Z 

goto 

Retrans 

/call 

CRC 

incf 

FSR,  F 

movf 

0,  W 

movwf 

ADDR-1 

;  Exec 

ute  ins 

truction  specified 

Command 

incf 

FSR,  F 

movf 

0,  W 

addwf 

PCL 

CmdO 

return 

Cmdl 

goto 

Chg  Pos 

Cnd2 

goto 

Chg_PosD 

Cmd3 

goto 

Chg_Gains 

Cmd4 

goto 

New^lnf o 

Cmd5 

goto 

New_lnf 0 

in 


by 


KX4) 


; move  address  of  first  bvte  to  FSK 
;read  address 
;  token  received 

;  check  tc  see  if  data  needs  to  be  s 


/Check  to  see  if  node  is  addressabl 
/first  byte  is  defining  address 


/message  not  for  this  node 
/check  CRC 

/move  next  byte  into  FSR  reaister 

/move  address  of  sendinc  byte  into 
/ADDR+l  register 

message 


/Transmit  data  in  Msg+n  to  Node  3 
Retrans 

goto  Send 


until  End  of  Message  byte  is  reached 


;  "CRCCalc"  calculates  CRC  and  adds  it  to  message 
CRCCalc 


movlw 
movwf 
clrf 
:L0  movf 
sublw 
btfsc 
goto 
movf 
addwf 
incf 
goto 
:bl  movf 
sublw 
movwf 
mcv^f 
incf 
movlw 
movwf 
return 


;  "CRC"  checks 
CRC  movlw 
movwf 
clrf 
:IjO  movf 
sublw 
btfsc 
goto 
movf 
addwf 
incf 
goto 
:Ij1  movf 

return 


Msg 

FSR 

CRCl 

0,  W 

EOMchr 

Z 

:L1 
0,  W 
CRCl,  F 
FSR,  F 
:L0 

CRC1,W 

0 

CRCl 

0 

FSR,  F 

EOMchr 

0 


CRC  at  end  of 
Msg 
FSR 
CRCl 
0,  W 
EOMchr 
2 

:  LI 
0,  W 
CRCl,  F 
FSR,  F 
:L0 

CRCl,  F 


;  Address  of  "Msg"  into  W 
;  Load  FSR  with  Command  Byte 
;  CRC  check  holder 
;  Read  command 

;  check  for  end-of -message  byte 

;  all  bytes  read,  check  if  CRC  is  zer 
;  Read  command 


;  next  command  byte 


message 

;  Address  of  "Msg"  into  W 
;  Load  FSR  with  Commia nd  Byte 
;  CRC  check  holder 
;  Read  comim»and 

;  check  for  end-of -message  byte 

;  all  bytes  read,  check  if  CRC  is  zero 
;  Read  command 


;  next  command  byte 
;  CRC  OK,  continue  processing 


;  "Send"  retransmits  back  command 
next  machine 

Send  movf  INTCON,W 

movwf  Tmpinc 

clrf  INTCON 


String 


;  store 


for  checking  or  passing  on 
entering  value  of  INTCON 


to 


bsf 

SIP 

movl  w 

Msg 

movwf 

FSR 

SO 

movf 

0,  W 

movwf 

ComReg 

bcf 

CREN 

bsf 

RPO 

bsf 

TXEN 

bcf 

RPO 

:X0 

btf  ss 

TXIF 

goto 

:X0 

XMIT 

movf 

ComReg/ W 

movwf 

TXREG 

movf 

0/  W 

sublw 

EOMchr 

btf  sc 

Z 

goto 

:S1 

:S0a 

incf 

FSR,  F 

goto 

SO 

:  S  1 

bsf 

RPO 

:  Sla 

bt  f  ss 

TRMT 

goto 

:  S 1  a 

;  bsf 

RPO 

bcf 

t>:en 

bcf 

RPO 

bsf 

CREN 

movf 

Tmpint / W 

movwf 

INTCON 

goto 

PrepO 

RS232 

bsf 

RPO 

movlw 

00100000b 

movwf 

T>:STA 

movlw 

32 

movwf 

SPBRG 

bcf 

RPO 

movlw 

10000000b 

movwf 

return 

RCSTA 

;  Address  of  “Msg”  into  W 
;  Load  FSR  with  Command  Byte 
;  Read  command 

;Disable  reception 


;  Read  command 

;  check  for  end-of -message  byte 
;  increment  FSR  register 


/•restore  interrupt  values 

/•Setup  transmit 

;9600  baud  using  20  MHz  crystal 
/•Enable  asynchronous  serial  port 


.  DELAY  subroutine - 

/■delays  are  set  for  9600  baud  using  20  MHz  crystal 


Delay  movlw 

82 

movwf 

DelCnt 

:D0  decfsz 

DelCnt 

goto 

:D0 

Hdelay 

movlw 

82 

movwf 

DelCnt 

:D1  decfsz 

DelCnt / F 

goto 

:D1 

84 


return 

Signed  Multiplication  routine:  [AC3+1  ACB]  =  ACB  ♦  ACC 


Mult  clrf 
clrf 
clrf 
clrf 
movlw 
btf  sc 
movwf 
movf 
movwf 
call 
:M1  clrw 
btf  sc 
call 
bcf 
rrf 
bcf 
rlf 
rlf 
movf 
bt  f  ss 
goto 
movf 
m.ovwf 
movf 
movwf 
movf 
movwf 
btf  sc 
call 
return 
:M2  movf 
addwf 
btf  ss 
incf 
movf 
addwf 
return 
:NEG  btfsc 
goto 

:NEGa  btfss 
return 
:NEG0  incf 
comf 
comf 
incf 
btfsc 
incf 
return 
:NEG1  incf 
comf 


SIGN 
TMP 
TMP  +  1 
ACB  +  1 
OFFh 

ACB,  MSB 
ACB  +  1 

ACC, W 
TMPl 
:NEG 

ACC,  0 

:M2 

C 

ACC,  F 
C 

ACE,  F 
ACB-1, F 
ACC,  F 
Z 

:  Ml 

TMP1,W 

ACC 

TMP-l, W 
ACB-1 
TMP,  W 
ACB 

SIGN, 0 
:NEG0 

ACB  ,  W 
TMP ,  F 
C 

TMP+l , F 
ACB-1, W 
TMP+1, F 

ACC,  7 
:NEG1 
ACB+1,7 

SIGN, F 
ACE,  1 
ACE+1, F 

ACB,  F 
Z 

ACB-rl,  F 

SIGN,  F 

ACC,  F 


85 


incf  ACC,F 

goto  :NEGa 

;  Delay  4.1  milliseconds  (w/  11.0592  MHz  crystal) 


D41 

movlw 

15 

movwf 

CNT 

clrf 

CNT+l 

:L0 

decf  S2 

CNTfl, 

goto 

:L0 

decf  sz 

CNT,  F 

goto 

:L0 

return 

;  De 

lay  long 

time 

D410 

clrf 

CNT 

clrf 

CNT-h  1 

:L0 

decf  sz 

CNT+1 , 

goto 

:L0 

decf  sz 

CNT,  F 

goto 

:L0 

return 

